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FOREWORD 


This document represents Volume XI of the final report 
on NASA Huntsville Contract entitled "Spin Vector Control 
for a Spinning Space Station". The report is prepared in 
two vo lumes : ' ■ 

Volume I - User's Manual 
'Volume II "- Analytical Manual 
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FINAL REPORT 


SPIN VECTOR CONTROL OF A ROTATING SPACE STATION 
VOLUME I: USER’S MANUAL 

By: T. Hendricks, Walter Guderlan,' George Haynes, Gary Johrison 

SUMMARY 

This document presents the formulation, computational logic, 
input/output options, subroutine description and other perti- 
nent information that should aid the user of the SPIN VECTOR 
CONTROL COMPUTER PROGRAM (MD246). 

I. INTRODUCTION 

This document is concerned with the design use and imple- 
mentation of a digital computer program to facilitate the 
study of the dynamic behaviour and control of dual spin space 
vehicles. This volume is a companion to Volume II (analytical 
manual) of the final report under NASA-Huntsvllle Contract 
NAS8-25247. 

The Spin Vector Control Program (MD246) is a Fortran 
Program that was written and checked out using the CDC 6400/ 

6500 digital computer. To minimize possible system incompat abili- 
ties care has been exercised to assume that only the basic fea- 
tures of the system are used. Thus the program should be 
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operable on most digital machines with a FORTRAN 4 compiler. 

The program is capable of solving the rotational dynamics 

t 

of dual spin earth orbiting spacecraft. Several control 
options as well as spacecraft configurations are possible. 
Among the available control actuators are CMGs, reaction 
wheels, reaction jets and torque motors. This program is 
intended for but not restricted to attitude control studies 
of a rotating space station. The generalized spacecraft con- 
figuration along with geometrical definitions is shown in 
Figure 1. Figure 2 is a specific spacecraft configuration. 

!J he remaining contents of this document discusses in 
varyi ig degree of detail how to use the program. The first 
chapt ir Input Deck Construction describes those cards which 
are necessary when exercising the various program options. 
Chapt r 2 Data Deck User's Guide presents a complete sequence 
and format description of all the data input cards. For a 
description and definition of the input variables refer to 
Appendix A. 
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INPUT DECK CONSTRUCTION 

'jhe basic data deck for operating the program with essen- 
tially no designated options is as follows. 

Card Variable 

1 NDECK - 

2 IPNDLM - 0 First card of run data. 

3 IPRINT = 

4 T START, TSTOP , DELTAT 

5 Alt. 

6-14 • TIB0I(1, 1) - TIBOI(3,3) 


15 

W0(1), W0(2), W0(3) 

16 

BOMASS 

17-25 

BODYOI (1,1) - BODYOI (3,3) 

26 

NUMCMG » 0 

225 

IPROPF = 0 

242 

BIMASS 

V 

243-251 

BODY1I (1,1) - B0DYlI(3 ,3) 

252 

THETAl 

253 

0MEGA1 

254 

D01(1), D0l(2) , D0l(3) 

255 

IB2F ** 0 

282 

SP 

283 

NGAIN “ 0 

294 

IGBAVF » 0 

295 

IDOCK - 0 
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Note that the above Is also a list of the cards that must 
always be present. 

Some examples of data deck arrangements for various options 
will be given. All data' decks consist of the basic data deck 
with changes indicated. 

1. Pendulum 

Card #2 IPNDLM = 1 

Before card #282 add cards #268 through #281, the 
pendulum parameter and Initial value data. 

2. Two single DOF CMGs 
Card #26 NUMCMG = 2 
After card #26 add - 

Card #27 ID0F(1) = 1 
#28. - HW(1) 

#29 - #37 A0CJ(1, 1, 1) - A0CJ(1,3,3) 

#38 - #42 All (1,1,1) - All (1,3,3) 

#47 - THATA(l) 

#48 - THATAD(l) 

#60 - IDOF (2) = 1 

#61 - HW(2) ‘ 

#62 - #70 AOC J (2,1,1) - A0CJ(2,3,3) 

#71 - #79 All (2, 1,1) - All (2^3,3) 

#80 - THATA(2) 

#81 - THATAD(2) 
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Card #283 NGAIN » 5 

After card #283 add cards #284 - #288 
(Cards #287 is control gain for CMC #1 and 
card #288 is control gain for CMG #2 in the 
present subroutines) 

3. Propulsion on Body 0 (no attitude control) 

Card #225 IPROPF “ 1 

After card #225 add - 

Card #226 IATTIF « 0 

Card #230 A0J(1) - (non-zero) CGAINO(I) 

Card' #231 A0J(2) * (non-zero) CGAIN0(2) 

i 

Card #232 AOJ(3) = (non-zero) CGAIN0(3) 
After card #259_,if present^ otherwise after card 
#255 add - 

Card #260 AU(l) - (non-zero) CGAINl(l) = 0 
Card #261 AlJ(2) « (non-zero) CGAXN(2) ■ 0 

4. Movable Mass 

Card #255 IB2F = 1 

After card #255 add cards #256 - #259 per- 
taining to movable mass 
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5. Attitude Control with Propulsion on Body 1 
Card. #225 1PR0PF = 1 

After card #225 add - 

Card #226 I ATT IF = 1 

Card #227 CA(1), CA(2), CA(3) 

Card #230 AOJ(l) - (non-zero) CGA;N(1) = 0 

Card #231 AOJ(2) =* (non-zero) CGAJN(2) * 0 

Card #232 AOJ(3) = (non-zero) CGA1N(3) = 0 

After card #259 if present, otherwise after card 
#255 add - 

Card #260 A1J(1) = (non-zero) CGAJtfl(l) 

Card #261 AlJ(2) = (non-zero) CGACNl(2) 

6 . Gravity Gradient 

Card #294 IGRAVF = 1 

7 . Docking 

Card #295 IDOCK = 1 

After card #295 add cards #296 - -307 docking 
quantities . 
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DATA DECK USER'S GUIDE 



.15 16 17 U 19 20 21 ???3 24 25 


28 2930 31 32 33 34 35 36 37 38 


/ I NfSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE; ALT 
FORMAT: + . E+ 

: 2 3 4 5 B 7 S 9 10 11 1? 


/CARD: 4 

/ INSTRUCTION: THIS CARD MUST .ALWAYS BE PRESENT. 

VARIABLES : TSTART TSTOP DELTAT 

FORMAT: + +. . + 

COLUMN: 2 3 4 1 0 2 0 * 10 11 12 -15 16 11 11 1*20 21 ??;] un - 2* 2S 30 31 32 33 


CARD: 

INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE: IPRINT 

FORMAT: 




/ CARD: 2 

' INSTRUCTION: THIS' CARD MUST ALWAYS BE PRESENT. 

VARIABLE: IPNDLM 

FORMAT: 

COLUMN: »■ 


CARD: 1 

INSTRUCTION: THIS CARD GOES “IN FRONT OF DATA DECK 1 ONLY. 

VARIABLE: NDECK 


FORMAT: 
COLUMN: ‘ ,*» 
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/ CARD: 14 

/ VARIABLE: TIBOI (3,3) 


/CARD: 13 

/ VARIABLE: TIBOI (3,2) 

j/fcARD: . 12 

/ VARIABLE: TIBOI (3,1) 

1/CARD: 11 

/ VARIABLE: TIBOI (2,3 ) 

/CARD: 10 

/ VARIABLE: TIBOI (2,2) 

y CARD: 9. ” 

' VARIABLE: TIBOI (2,1) 

^ GARD: 8 ~~ 

VARIABLE: TIBOI (1,3) 

CARD: 7 

VARIABLE: TIBOI (1,2) 


/CARD: 6 

/ INSTRUCTION: THE NEXT 9 CARDS MUST ALWAYS BE PRESENT. 

VARIABLE: TIBOI (1,1) 

FORMAT: I + 

COLUMN : inn i.uy mb. 


i 
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/ CARD: 16 

INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

-VARIABLE: BOMASS 

FORMAT: + . E+ 

COLUMN i ? a < » 8 7 t a idii i; ’ 1 

/CARD: 15 

/ INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLES: WO(l) WO(2) WO(3) 

FORMAT: + + + 

2 3 ^ 5 6 7 t noil 12 15 1 61119 19 22 21 27 21 24 25 • SM .1 32 33 7 4 35 3 6 V 39 
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/CARD: 28 

/ INSTRUCTION: IF NUMCMG = 0, IGNORE THIS CARD. 

VARIABLE: HW (1) 

FORMAT: + . E+ 

COLUMN : niiiuiwim 

/CARD: 27 

/ INSTRUCTION: IF NUMCMG = 0, IGNORE THIS CARD. 

VARIABLE: IDOF (1) 

FORMAT: { 

1 COLUMN; JL' ... __ 

/ CARD: 26 

/ INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE: NUMCMG 

FORMAT: 

COLUMN: j 
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CARD: 37 

VARIABLE : AOCJ (1,3,3) 


j/CARD: 36 

/ VARIABLE: AOCJ (1,3,2) 

/CAKD: 35 

/VARIABLE: AOCJ (1,3,1) 


/CARD: 34 

/ VARIABLE: AOCJ (1,2 , 3) 

/CARD: 33 

(VARIABLE: AOCJ (1,2,2) 


/ CARD: 32 

/ VARIABLE: AOCJ (1,2,1 


/ CARD: 31 

' VARIABLE: AOCJ (1,1,3 


/ CARD: 30 

' VARIABLE: AOCJ (1,1,2) 


CARD: 29 

INSTRUCTION: IE NUMCKG = 0, IGNORE THE NEXT 9 CARDS. 

VARIABLE: AOCJ (1,1,1) 

FORMAT; + 

COLUMN : j j 4 t > j a 9 to « b 
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CARD: 48- 

VARIABLE: THATAD (1) 

FORMAT: + 

COLUMN : !i«s,un in tt « 





'CARD: 57 

VARIABLE: 


AIO (1,3,3) 


j/CAED: 56 

/ VARIABLE: AIO (1,3,2) 


j/GAKD: 55 

VARIABLE: AIO (1,3,1) 


'CARD: 54 

VARIABLE: AIO (1,2,3) 



CARD: 53 

VAMABLE: A!0 (1,2,2) 

V CARD: 52 

VARIABLE: AIO (1,2,1) 


CARD: 51 

VARIABLE: AIO (1,1,3) 


CARD: 50 

VARIABLE: AIO (1,1,2) 


CARD: 49 

INSTRUCTION: IF NUMCMG = 0, OR IDOF (1) 

IGNORE THE NEXT 9 CARDS. 
VARIABLE: AIO (1,1,1) 

FORMAT: + 

COLUMN : S 3 4 S.6 1 8 9 10 II K, 


= 0, OR IDOF (1) = 1, 
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/CARD:. 61 

/ INSTRUCTION: IF NUMCMG < 2 , IGNORE THIS CARD. 

VARIABLE: HW (2) 

FORMAT : f , E+ 

COLUMN: ; ] 4 a b t b 9 io it i» 

/ CARD: 60 

/ INSTRUCTION: IF NUMCMG < 2, IGNORE THIS CARD. 

VARIABLE: IDOF (2) 

FORMAT: 

1 COLUMN: il : 

/ CARD: 59 

/ VARIABLE: FEED ('!) 

FORMAT: + 

COLUMN: 2 3 4 J.» I 910 1112 

/CARD: '58 

/ INSTRUCTION: IF NUMCMG = 0, OR IDOF (1) = 0,. OR IDOF (1) = 1, 

IGNORE THE NEXT 2 CARDS. : 

VARIABLE: FEE (I) 

FORMAT: + 

COLUMN : 2 3 4 5 
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CARD: 79 

VARIABLE: All (2,3,3) 



CARD: 78 

VARIABLE: All (2,3,2) 

V CARD: 77 

VARIABLE : All (2,3,1) 


CARD: 76 

VARIABLE: All ( 2 . 2 . 3 ") 


CARD: 75 

VARIABLE: All (2.2.2) 

CARD: 74 

VARIABLE: All (2,2,1) 


CARD: 73 

VARIABLE: All (2.1^ 


CARD: 72 

VARIABLE: All (2,1,2) 


CARD: 71 

INSTRUCTION: IF NUMCMG < 2, OR IDOF (2) 

IGNORE THE NEXT 9 CARDS. 
VARIABLE: All (2,1,1) 

FORMAT : + 

COLUMN : ij \ s b i.ii ii n i? 


= 0 , 


/ 
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/CARD: 81 

/ INSTRUCTION: IF NUMCMG < 2, OR IDOF (2) = 0, IGNORE THIS- CARD. 

VARIABLE: THATAD (2) 

FORMAT: + 

COLUMN : i ] t ! t i i mini 

/CARD: 80 

/ INSTRUCTION: IF NUMCMG < 2, OR IDOF (2) = 0, IGNORE THIS CARD. 

VARIABLE: THATA (2) 

FORMAT: + 

COLUMN : $ 1 | 9J» II 12 
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/ CARD: 90 

/ VARIABLE: AIO (2,3,3) 


L/CARD: 89 
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CARD: 103 

VARIABLE: AOCJ (3,3,3) 




CARD: 102 

VARIABLE: AOCJ (3, 3., 2) 


/CARD: 101 

/ VARIABLE: AOCJ (3,3,1) 


/CARD: 100 

/ VARIABLE: AOCJ (3, 2,3) 

/card: 99 

VARIABLE : AOC J (3 , 2 , 2 ) 


CARD: 98 

VARIABLE: AOCJ (3,2,1) 


/ CARD: 97 

/ VARIABLE: 


VARIABLE: AOCJ (3,1,3) 


CARD: 96 

VARIABLE: AOCJ (3,1,2) 




CARD: 95 

INSTRUCTION: 15 NIMCMG <3, IGNORE THE NEXT 9 CARDS. 

VARIABLE : AOCJ (3,1,1) 

FORMAT: + * . 

COLUMN : istiiM 9 jo ii i 2 
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/CARD: 114 

/ INSTRUCTION: IF NUMCMG < 3, OR IDOF (3) = 0, IGNORE THIS CARD. 

VABIABLE: THATAD (3) 

FOFMAT : + 

GOT UMN : J _3J_ 5_ S_ 1 8 9 1 0 II 12 

/ CARD: 113 

f INSTRUCTION: IF NUMCMG < 3, OR IDOF (3) = 0, IGNORE THIS CARD. 

VARIABLE: THATA (3) 

FORMAT: + 

COLUMN: ! u j n_i sjoinz 


26 



27 






CARD: 136 

VARIABLE: AOCJ (4,3,3) 





/ CARD: 130 

' VARIABLE: AOCJ (4,1.3' 


/ CARD: 129 

VARIABLE: AOCJ (4,1,2) 



CARD: 128 

INSTRUCTION: IE NUMCMG < 4, IGNORE THE NEXT 9 CARDS. 

VARIABLE : AOC J (4 , 1 , 1 ) 

FORMAT: . + 

COLUMN : 2 3 1 5 6 7 6 6 10 II 12 
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/CARD: 147 

/ INSTRUCTION: IF NUMCMG < 4, OR IDOF (4) = 0, IGNORE THIS CARD. 

VARIABLE: THATA (4) 

FORMAT: + 

COLUMN : 2 2 4 ; 'e 7 » a 10 n ir 

/CARD: 146 

/ INSTRUCTION: IF NUMCMG < 4, OR IDOF (4) = 0, IGNORE THIS CARD. 

VARIABLE: THATA (4) 

FORMAT: + 

COLUMN: 2 i<M)isiin!i 
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/ CARD: 156 

/ VARIABLE: AIO (4,3,3) 


CARD; 155 



/ CARD: 148 

INSTRUCTION: IF NUMCMG < 4, OR IDOF (4) >= 0, OR IDOF (4) = 1, 

IGNORE THE NEXT 9 CARDS. 

VARIABLE: AIO (4,1,1) 

FORMAT: + 

COLUMN : 2 34 J E 7 8»]0ltli 
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CARD: 169 

VARIABLE ; AOC J (5,3,3) 


/CARD: 168 

/ VARIABLE: AOCJ (5,3,2) 

y CARD: 167 

/ VARIABLE : AOC J (5 , 3 , 1 ) 

/CARD: 166 

(11 RIABLE: AOCJ (5,2,3) 

/CARD: 165 

f VARIABLE: AOCJ (5,2,2) 

' CARD: 164 

VARIABLE ; AOCJ (5,2,1) 

CARD: 163 

.VARIABLE:. AOCJ (5..U3) 

CARD: 162 

VARIABLE : AOCJ (5,1,2) 


CARD: 161 

INSTRUCTION: IF NUMCMG < 5, 

VARIABLE : AOC J (5 , 1 , 1 ) 

FORMAT: + 

COLUMN : u < 5 s 1 1 gmnu 


IGNORE THE NEXT 9 CARDS. 
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CARD: 178 

VARIABLE: All (5,3,3) 


/ CARD: 177 

VARIABLE; All (5,3,2) 

CARD: 176 

VARIABLE: All (5,3,1) 


/ CARD: 175 

/ VARIABLE: All (5,2, 3) 

/ CARD: 174 

f VARIABLE: All (5,2,2) 


/ CARD: 173 

' VARIABLE: All (5,2,1 


V CARD: 172 

/ VARIABLE: All (5,1,3 


/ CARD: 171 

' VARIABLE; All (5,1,2) 



CARD: 170 

INSTRUCTION; IF NUMCMG < 5, OR IDOF (5) 
IGNORE THE NEXT 9 CARDS. - 
VARIABLE: All (5,1,1) 

FORMAT: .+ 

COLUMN : 1 1 « s 1 1 i noun 
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CARD: 202 

VARIABLE: AOCJ (6,3,3) 
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/CARD: 2X1 

/ VARIABLE: All (6,3,3) 



Y CARD: 210 

VARIABLE: All (6,3,2) 


CARD: 209 

VARIABLE: All (6,3,1) 

CARD: 208 

VARIABLE: All (6,2,3) 


CARD: 207 

VARIABLE: All (6.2.2) 


CARD: 206 

VARIABLE: All (6,2,1) 


CARD: 205 

VARIABLE: All (6,1,3) 


CARD: 204 

VARIABLE: All (6,1,2) 


CARD: 203 

INSTRUCTION: IF NUMCMG < 6, OR IDOF (6) *= 0, 

IGNORE THE NEXT 9 CARDS. 
VARIABLE: All (6,1,1) 

FORMAT: + 

COLUMN : n.miiiiDiiii 
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CARD: 213 

INSTRUCTION: IF NUMCMG < 6, OR IDOF (6) = 0, IGNORE THIS CARD. 

VARIABLE: THATAD (6) 

FORMAT:' + 

COLUMN : 2 3 4 5 S J » 9 10 II 12 


CARD: 212 

INSTRUCTION: IF. NUMCMG < 6, OR IDOF (6) = 0, IGNORE THIS CARD. 

VARIABLE: THATA (6) 

FORMAT: + 

COLUMN : 2 i s > a mo ii n 
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DUE. ro MODIFICATIONS; TKE ME XT OATH CAKD 
HAS THE MIAMBER 230, 


• I5 16I7II 19 70 21 22 23 24 25- 


_ 2629 30 31 32 3134 35 36 37 36 - 


/ CARD; 227 

/ INSTRUCTION : IF IPROPF OR IATTIF - 0, IGNORE THIS CARD. 

VARIABLES: CA(1) CA(2) CA(3) 

FORMAT : + + , + a 

/ —— UMN . 2 3 4 5 S J 6 9 10 11 12 15 16 17 16 19 20 21 22 23 24 25 2629 30 3! 32 31 34 35 36 37 36 

CARD: 226 ‘ 

INSTRUCTION; IF IPROPF » 0. IGNORE THIS CARD. 

VARIABLE: IATTIF 

FORMAT : 

COLUMN: .3 


/ CARD; 225 

INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE: IPROPF 

FORMAT; 

COLUMN: j 


CARD: 224 

VARIABLE: FEED <6) 


CARD: 223 

INSTRUCTION: IF NUMCMG < 6, OR IDOF (6) - 0, OR IDOF (6)= 1, 

IGNORE THE NEXT 2 CARDS, 
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■pUE TO /VIODIFIWXONJS , THE NEXT DATA CA^D 
H A*> THE NIAM6ER 2.A 2. . 
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preceding page blank N9WED 


CARD; 251 

VARIABLE: BODYlI (3,3) 



/ CARD: 250 

/ VARIABLE: BODYlI (3,2) 


y CARD: 249 

/ VARIABLE: BODYlI (3,1) 


CARD: 248 

VARIABLE: BODYlI (2,3) 


CARD: 247 

VARIABLE: BODYlI (2.2 


246 

LE: BODYlI (2,1) 


CARD: 245 

VARIABLE: BODYlI (1,3 


CARD: 244 

VARIABLE: BODYlI (1,2) 


CARD: 243 

INSTRUCTION: THE NEXT 9 CARDS MUST ALWAYS BE PRESENT, 

VARIABLE: BODYlI (1,1) 

FORMAT:- ± . ■ E+ 

COLUMN : n 4 1 c 1 1 tiuni 
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^ CARD: 255 

/ INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE: IB2F 

FORMAT: 

i COLUMN: 3 

/CARD: 254 

/ INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLES: DOl(l) D0l(2) DOl(3) 

FORMAT: ± + + 

C.QLUM: 2 3 4 5 I 7 8 9 10 11 12 15 IS 1 1 19 19 20 21 72 23 ?< ?5 28 29 30 31 32 33 34 3536 37 33 

/ CARD: 253 

/ INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE: OMEGA I 

FORMAT: + 

'■ COLUMN: 2 3 4 5 6 791 Hit 12 

CARD: 252 

INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE: THETA1 

FORMAT: + 

COLUMN : 2 3 4 5 3 J 8 9 101112 
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/CARD: 259 

/ INSTRUCTION: IF IB2F ** 0, IGNORE THIS CARD. 

VARIABLES : S SDOT 

FORMAT: + + 

‘ COLUMN i 7*3 4 8 1 ; 8 sipim sjsnuia 302133332435 

/CARD: 258 ' 

/ INSTRUCTION: IF IB2F =0, IGNORE THIS CARD. 

VARIABLES: S2(l) S2(2) S2(3) 

FORMAT: + + + 

COLUMN: 3 3 4 5 6 7 8 S 10 II 1 7. J5 I6_*M8J9 }0 31 333334 3 5 383) 30 31 33 33 34 3336 3) 33 

/ CARD: 257 

/ INSTRUCTION: IF IB2F « 0, IGNORE THIS CARD. 

VARIABLES: Dl2(l) DI2(2) D12(3) 

FORMAT: ' + • . ± ± 

COLUMN i 3 3 4 5 6 7 8 5 10 H 13 15 16 I) H 13 30 31 322334 3 8 33 33 30 31 33 33 34 35 35 37 38 

/ card/ 256 

/ INSTRUCTION: IF IB2F =* 0, IGNORE THIS CARD. 

VARIABLE: B2MASS 

FORMAT: ± . E+ 

COLUMN : 2 3 4 5 6 7 8 8 10 11 13 


48 


PUE TO /n.ODT FXC ATXONJS ^ THE. ME* T ORTA CAR-D 
(4AS THE NUMBER Z(^l. 


/ CARD: 26J. 

/ VARIABLES: AlJ(2) CGAINl(2) 


/ CARBs 260 



( INSTRUCTION: IF IPROPF » 

0, IGNORE THE NEXT Z CARDS. 


VARIABLES: AlJ(I) 

CGAINl(l) 


FORMAT: + . . E+ 

+ . E+ 


COLUMN : 2 3 < 5 1 i « 9 io n b 

Kjejnaj^o; 1 njn 425 

i 
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/gAKDs 271 

/ INSTRUCTION: IF ZPNDLM » 0, IGNORE THIS CARD, 

VARIABLES: Dl3(l) D13(2) D13(3) 

FORMAT: ± ± + 

COLUMN ! inn i s s io ii i; i 5 i 6 imaa>?mn»is a? 3 :o 3132 33 » 153; n 3 i 

/ CARD: 270 

/ INSTRUCTION: IF IPNDLM = 0, IGNORE THIS CARD. 

VARIABLE: B3MASS 

FORMAT: + . E+ 

COLUMN: 1 n 1 mini " . 

/CARD: 269" 

/ INSTRUCTION: IF IPNDLM ■ 0, IGNORE THIS. CARD. 

VARIABLE: CP2 

FORMAT: + . E+ 

2 1 4 a a 7 8 9 io 11 ii 

y CARD: 268 

/ INSTRUCTION: IF IPNDLM = 0, IGNORE THIS CARD. 

VARIABLE: CPI 

FORMAT: + . E+ • 

COLUMN : 2 3 < 5 6 7 » 9 10 n i? 
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/cARD : 275 

/ INSTRUCTION: IF IPNDLM - 0 t IGNORE THIS CARD. 

VARIABLE: OMEGA3 

FORMAT: + 

— CiQLUMN: 234557191011 12 

/ CARD: 274 

/ INSTRUCTION: IF IPNDLM = 0, IGNORE THIS CARD. 

VARIABLE: THETA3 

FORMAT: + 

COLUMN: 2355576910 11 1? 

/ CARD; 273 

/ INSTRUCTION: IF IPNDLM = 0, IGNORE THIS CARD. 

VARIABLE: PEND3L 


FORMAT:. 

COLUMN:' 


2 3 4 5 6 7 6 1 10 II 12 


CARD; 272 

INSTRUCTION: IF IPNDLM 

VARIABLES: S3(l) 

FORMAT: + 

COLUMN : j 3 4 5 « 7 • 9 10 11 12 


0, IGNORE THIS CARD. 

S3 (2) S3 (3) 

+ . + 


15 II 17 II 11 20 2122 23 24 25 


2929 3 0 3132 3334 3531 37 36 


51 




53 





54 




CARD: 293 

INSTRUCTION: IF NGAIN < 10, IGNORE THIS CARD. 

VARIABLE: GAIN (10) 

FORMAT: ± • E ±- 

— COLUMN : 2 3 4 5 s ? » s to » 12 


CARD; 292 - 

INSTRUCTION: IF NGAIN < 9, IGNORE THIS CARD. 

VARIABLE: GAIN (9) 

FORMAT: + . E+ 

COLUMN: 


2 3 4 6 s 7 s a to II 12 


CARD: 291 ■ 

INSTRUCTION: IF NGAIN <8, IGNORE THIS CARD. 

VARIABLE: GAIN (8) 

FORMAT: + . E+ . 

COLUMN: 2 j < 5 s ; 1 9 io i] t 2 . 


CARD; 290 

INSTRUCTION: IF NGAIN < 7, IGNORE THIS CARD. 

VARIABLE: GAIN (7) 

FORMAT: + . E+ 

COLUMN: 2 3 < j ! 7 1 » 10 n 12 


CARD': 289 

INSTRUCTION: IF NGAIN < 6, IGNORE THIS CARD. 

VARIABLE: GAIN (6) 

FORMAT: + . E+ 

COLUMN : 2 3 4 5 8 7 t 9 10 1112 
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/ CARDS 297 

/ INSTRUCTION: IF .IDOCK » 0, IGNORE THIS CARD. 

VARIABLE : BDMASS 

FORMAT: + . E+ 

COLUMN : j a < s t j_a_ 9 10 11 12 

/ CARD; 296 

/ INSTRUCTION: IF IDOCK - O’) EgNORE THIS Cfr(?D. 

VARIABLE: DTIME 

FORMAT: + 

COLUMN: 2 3 4 9 111 9 10 11 II 

/ CARD: 295~ 

/ INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE: IDOCK 

FORMAT: 

COLUMN: 1 __ 

/ CARD: 294 • 

/ INSTRUCTION: THIS CARD MUST ALWAYS BE PRESENT. 

VARIABLE: IGRAVF 

FORMAT: 

COLUMN: 1 : 
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CARD: 306 

VARIABLE: BODYDI (3,3) 


y CARD: 305 

./ VARIABLE: BODYDI (3,2) 


y CARD; 304 

/ VARIABLE; BODYDI (3 t ,l) 


/ CARD: 303 

/ VARIABLE: BODYDI (2,3) 


/ CARD: 302 

' VARIABLE: BODYDI (2.2 


/ CARD: 301 

VARIABLE : BODYDI (2.1 



/ CARD: 299 

VARIABLE: BODYDI (1,2) 


CARD: 298 

INSTRUCTION: IE IDOCK « 0, IGNORE THE NEXT 9 CARDS. 

VARIABLE: BODYDI (1,1) 

FORMAT: + , E+ 

COLUMN : nuummui 
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A 


CARD: 308 

INSTRUCTION: IF IDOCK =0, IGNORE THIS CARD. 

VARIABLES: DDOl(l) DD0l(2) DD0I(3) , 

FORMAT: ± , ± ± 

COLUMN: ; 3 < 5 t ; I ] 11 11 c is is 17 13 is 30 21 222321 25 339311 313; 31343535 37 is 


CARD: 307 

INSTRUCTION: IF IDOCK « 0, IGNORE THIS' CARD. 

VARIABLES: DTI(l) DTI (2) DTI(3) 

FORMAT: + 

— o “ 

COLUMN: . 2 3 S S 6 7 8 3 10 lie IS IS 17 la 19 3 0 21 23 23 2 ( 35. * 3829 30 31 3333 M 35 3S 3738 
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APPENDIX A, DEFINITIONS AND REFERENCES FOR INPUT VARIABLES 

This appendix is in two parts. The first part contains 
a list of all input variables in alphabetical order. The 
second part contains the input variables in categories and 
the input variables in each category are alphabetized. 


[AII(J,M,N)1 ; 


[AII(J,M,N>] 



All (1,1,1) 
All (J, 2,1) 
All (J, 3,1) 


AII(J, 1,2) 
All (J, 2, 2) 
All (J, 3, 2) 


All (J, 1,3) 
AII(J ,2,3) 
AII(J,3,3) 


This array is the inertia matrix for the inner gimbal. of 
the Jth control moment gyro aboard the stator. A maximum of 
six CMGs may be used. (i.e. J = 1,6) All CMGs are also’ con- 
strained to be located at the center of mass on the stator, body 
0. If the Jth CMG has one or two degrees of freedom, it will 
have an inner gimbal. (Refer to the write up on CMGs for further 
discussion.) 

UNITS: (sl‘ug-ft 2 ) 

FORMAT: # 5006 » (IX, F11.5) 


AI0(J ,M,N) ; 


[AI0(J,M,N)] = [iOj] 


St 


AIO(J,l,l) 
AI0(J,2, 1) 
AI0(J,3,1) 


AIO (J, 1,2) AIO(J, 1,3) 
AIO (J,2,2) AI0(J,2,3) 
AI0(J,3,2) AIO(J,3,3) 


This array is the Inertia matrix for the outer gimbai of 
the Jth control moment gyro aboard the stator. A maximum of 
six CMGs may be used. (i.e. J = 1,6) All CMGs are constrained 
to be located at the center of mass on the stator, body 0. The 
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Jth CMG will have an outer gimbal only if it hag two degrees of 
freedom. (Refer to the write up on CMGs for further discussion.) 

UNITS: (slug-ft 2 ) 

FORMAT: # 5006 - (IX, F11.5) 

ALT : 

ALT is altitude of the center of mass of the space station 
configuration measured from the surface of the earth. All 
orbits are constrained to be circular with no ob lateness effects. 
Therefore, altitude is the only pertinent orbit parameter. 

UNITS: (miles) 

FORMAT: # 5004 - (IX, Ell. 4) 

AOCJ ( J ,M,N) : 

A0CJ(J,1,1) AOCJ (J, 1,2) AOCJ (J, 1,3) 
[A0CJ(J,M,N)] « [°> c j] ~ AOCJ (J,2,l) AOCJ (J, 2, 2) A0CJ(J,2,3) 

AOCJ (J,3 ,1) AOCJ (J, 3, 2) A0CJ(J,3,3) 

This array is the coordinate transformation matrix from the 
CMG null gimbal coordinate frame _to the coordinate frame of body 
0, the stator. (Refer to the coordinate transformation appendix.) 
For example, consider the two coordinate systems shown below: 



Body' 0 Frame Jth Null Gimbal Frame 
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For the above situation: 


0 . 


0 . 


1 . 


[AOCJ (J,M,N)] 


1 . 0 . 0 . 

0. X. 0. 


UNITS: (None) 

FORMAT; # 5006 = (IX, FIX. 5) 


AO J (M) : 

A0J(1) Is the distance between the jets of the pure coupXe 
producing the torque around the X axis of body 0. 

A0J(2) Is the distance between the jets of the pure coupXe 
producing the torque around the- Y axis of body 0. 

A0J(3) is the distance between the jets of the pure coupXe 
producing the torque around the Z axis of body 0. 

Note: The variables CGAIN0(1), CGAIN0(2), and CGAIN0(3) 

are aiso read on the same data cards as A0J(1), 
A0J(2), and A0J(3). Punch the vaiues of A0J(1), 
AOJ(2), and A0J(3) in columns 2 through 12 of the 
data cards . Non-zero vaiues shouid be read in for 
A0J(M). Control on an axis can be disabied by read- 
ing zero. for the CGAIN0. 

UNITS: .(feet) , 

FORMAT: 5008 = (XX, Ell. 4, 2X, El 1.4) 

AX J (M) : 

AlJ(l) is the distance between the jets of the pure coupXe 
producing the torque around the X axis of body 1. 

A1J(2) is the distance between the jets of the pure couple 
producing the torque around the Y axis of body X. 

Note: The variables CGAIN1(1) and CGAIN1(2) are also 

read on the same data cards as A1J(1) and A1J(2). 
Punch the values of AlJ(l) and AlJ(2) in columns 2 
through 12 of the data cards. Nonzero values should 
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be read in. for A1J(M). Control on an axis can be 
'disabled by reading zero for the CGAINl. 

UNITS: (feet) 

FOBMAT: # 5008 - (IX, Ell.4, 2X, Ell. 4) ' 


BDMASS : 

BDMASS is the sum of the mass of body 0, the stator, and 
the mass of the docking 'vehicle-. The docking vehicle is con- 


strained to dock on body 0, 

the stator. - 

BDMASS ** 


UNITS:' (slugs) 

■ 



FOBMAT: # 5004 ■ (IX, : 

Ell.4) 



BODYDI (M,N) 





B0DYDI (1,1) 

B0DYDI(1,2) 

BODYDI (1,3) 

[B0DYDI(M,N)] ■ [l ] »■ 

B0DYDI (2,1) 

BODYDI (2,2) 

BODYDI (2, 3) 

- 

B0DYDI(3,1) 

BODYDI(3,2) 

BODYDI (3,3) 


This array is the inertia matrix of the docked body which 
consists of the docking vehicle connected to the stator ^ 

UNITS: .(slug-ft 2 ) 

FORMAT: # 5004 - (IX, Ell. 4) 


BODYOI (M.N) : 


[bodyoi (M,N)] = [l Q ] = 


BODYOI (1,1) 
BODYOI (2,1) 
BODYOI (3,1) 


800101 ( 1 , 2 ) 
BODYOI (2, 2) 
BODYOI (3, 2) 


BODYOI (1,3) ' 
BODYOI (2,3) 
BODYOI (3,3) 
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This array is the inertia matrix of body 0, the stator. 
UNITS: (slug-ft 2 ). 

FORMAT: # 5004 » (IX, Ell. 4) 


B0DY1I (M,N) : 


[bodyli (M,N)] 



BODYlI(l,l) 
BODY1I (2,1) 
BODYlI(3, 1) 


BODYll(l,2) BODY1I (1,3) 
BODYlI (2,2) BODY1I (2,3) 
BODYlI (3,2) B0DY1I(3,3) 


This array is the inertia matrix for body 1, the rotor. 
UNITS: (slug-ft 2 ) 

FORMAT: # 5004 = (IX, Ell.4) 


BOMASS : 

B0MASS is the mass of body 0, the stator. BOMASS <= m^ 
UNITS: (slugs) 

FORMAT: # 5004 ~ (IX, Ell.4) 


BlMASS : 

BIMASS is the mass of body 1, the- rotor. BlMASS ==' 
UNITS: (slugs) 

FORMAT: # 5004 ® (IX, Ell.4) 

B2MASS : 

B2MASS is the mass of body 2, the elevator. B2MASS = m^ 
UNITS; (slugs) 
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FORMAT: # 5004 - (IX, Ell. 4) 

B3MASS : 

B3MASS is the mass of body 3, a pendulum. B3MASS *= m^ 
UNITS: (slugs) 

FORMAT: # 5004 - (IX, Ell. 4) 

B4MASS : 

B4] tASS is the mass of body 4, a pendulum. B4MASS = m^ 
UNITS: (slugs) 

FORMAT; # 5004 - (IX, Ell. 4) 


CA(M) : 

CA(1)', GA(2), and CA(3) are the three direction cosines 
of the desired attitude reference direction in the inertial 
frame. 


UNITS: (None) 

FORMAT: # 5002 = (IX, 3(F11.5, 2X)) 


CGAINO(M) : 

CGAINO(l) equals the control gain of all four reaction 
jets in the pure force couples producing torque around the X 
axis of body 0. 

CGAIN0(2) equals the control gain of all four reaction 
jets in the pure force couples producing torque around the Y 
axis of body 0. 

0GAIN0(3) equals the control gain of all four reaction 
jets In the. pure force couples producing torque around the Z 
axis of body 0. 
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Note : 


The variables A0J(1), A0J(2), and A0J(3) are also 
read in on the same data cards as CGAINO(I), 
CGAIN0(2) , and CGAINO (3 ) . Punch the values of 
CGAINO (1) , CGAINO (2), and CGAIN0(3) in columns 
15 through 25 of the data cards. 

UNITS : (lb / rad ians / second ) 

FORMAT: # 5008 » (IX, El 1.4, 2X, Ell. 4) 


GGAINI(M) : 

CGAINl(l) equals the control gain of all four reaction 
jets in the pure force couples producing torque around the X 
axis of body 1. 

CGAIN1(2) equals the control gain of all four reaction 
jets in the pure force couples producing torque around the Y 
axis of body 1. 

Note; The variables AlJ(l) and A1J(2) are also read 

in on the same date cards as CGAINl(l) and CGAINl(2). 
Punch the values of CGAIN1(1) and CGAINl(2) in 
columns 15 through 25 of the data cards. 

UNITS: (lb/radians /second) 

FORMAT: # 5008 - (IX, Ell. 4, 2X, Ell. 4) 


CPI and CP2: 


CPI and CP2 are parameters used in determining the stiff- 
ness and the resonant frequency of the pendulums. For example, 
the control laws which are governed by the parameters are: 

T13 * - CPI * OMEGA3 - CP2 * THETA3 

T14 = - CPI * 0MEGA4 - CP2 * (THETA4 - it) 

Note: These variables are read on separate data cards. 

UNITS : (none) 

FORMAT: # 5004 » (IX, El 1.4) 



DD01(M) : 


0001(1), DD01(2), and DDOlt.3) are the X, Y, and Z components 
of the vector from the center of mass of the docked body to the 
hinge line, of body 1, the rotor. The vector is expressed in 
body 0 coordinates. The docked body shall be defined as the 
configuration of the docking vehicle attached to body 0. 

UNITS: (feet) 

FORMAT: # 5002 » (IX, 3(F11.5, 2X)) 


DELTAT :- 

DELTAT = At 

DELTAT is the time increment used In the Integration 
algorithm which solves the rotational equations of motion. 

When "TIME" is updated we have: 

TIME => TIME + DELTAT 

Note: Punch the value of DELTAT in columns 28 through 38 

UNITS: (seconds) 

FORMAT: # 5002 = (IX, 3(F11.5, 2X)) 


D01(M) : 

D01(l), D01(2), and D01(3) are the X, Y, and Z components 
of the vector from the center of mass of body 0 to the hinge 
line of body 1, the rotor. The vector is expressed in body 0 
coordinates. D01(l) should in most cases be zero. 

UNITS : (feet) ' 

FORMAT: # 5002 «* (IX, 3(F11.5, 2X)) 


DTI (M) : 

DTI (1) , DTI (2) and DTI (3) are the X, Y, and Z components 
of the docking torque - impulse. 
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UNITS: lb-ft-sec 


FORMAT: # 5002 - (IX, 3 (ELI. 5, 2X)) 


DTIME : 

DT3ME is the time when docking occurs, (i.e. "Docking Time") 
The restrictions placed on DTIME are as follows: 

a) T „ _ < DTIME < T ‘ 

start stop 

b) DTIME must be an. integer multiple of At. 

UNITS: (seconds) 

FORMAT: #5006 » (IX, F11.5) 


D12.(M) : 

Dl2(l), Dl2(2) and Dl2(3) are the X, Y and Z components of 
a fixed vector locating the starting position of the movable 
mass,, the elevator. The vector equation that describes the 
motion of the movable mass is = d.„ 4- s^s. Where s~ is a 
unit vector which defines the direction in which the movable 
mass travels and s is a scalar prespecified function of time. 
For most cases s-(t = 0) = 0 so that d specifies the initial 
starting position of the movable mass. The elevator Is known 
alternately as the movable mass or body 2. D12 is expressed 

in body 1 coordinates. For example, if the elevator were con- 
strained to travel along the X axis, then cL- could have the 
following values: D12(1) = 1., D12(2) = 0., D12(3) = 0. 

UNITS: (feet) 

FORMAT: # 5002 « (IX, 3 (ELI. 5, 2X)) 


DI3 (M) : 

Dl3(l), Dl3(2), and Dl3(3) are the X, Y, and Z. components 
of .the vector from. the center of mass of body 1 to the hinge 
line of body 3. Dl3 is expressed in body 1 coordinates. 

UNITS : (feet) 
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FORMAT; # 5002 « (IX, 3(Fll.5, 2X)) 


DI4(M) : 

014(1), D14(2), and Dl4(3) are the X, Y, and Z components 
of the vector from the center of mass of body 1 to the hinge 
line of body 4. 

D14 is expressed in body 1 coordinates, 

UNITS': (feet) 

FORMATS # 5002 «* (IX, 3(F11.5, 2X)) 


FEE(J) : 

FEE(J) = 0 

FEE(J) is the outer gimbal angle of a two degree of freedom 
control moment gyro as shown pictorially below; 



The subscript J refers to the number assigned to the CMG. 
(Refer to the write up on GMGs for further discussion.) 

UNITS; (radians) 

- FORMAT: # 5006 = (IX, F11.5) 
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INITIAL VALUE AT TIME - ^ start 

FKEP(J) : 

FEED (J) » 0j 

FEED(J) is the outer gimbal rate of a two degree of freedom 
control .moment gyro. The subscript J refers to the number 
assigned to the CMG. (Refer to the write up on CMGs for further 
discussion.) 

UNITS: (radians/second) 

FORMAT: # 5006 = (IX, Fll.5) 


GAIK QM) : 

GAIN(M)' is an array of numbers the dimension of which Is 
determined by' another input variable NGAIN. These numbers, 
once read in, are stored in common and can be used for a variety 
of purposes. In many CMG control laws it is necessary to have 
control gains. GAIN(M) can be used for this purpose among others. 

UNITS: (None) 

FORMAT-: # 5004 “ (IX, Ell. 4) 


Hff(J) : 

HN(J) is the angular momentum of the wheel associated with 
the Jth momentum device. (Refer to the write up on CMGs for 
further discussion.) 

UNITS: (slug-ft^/second) . 

FORMAT: # 5004 “ (IX, El 1.4) 


IATTIF : 

IATTIF is the attitude flag. 

IATTIF “ 1 implies an attempt to change attitude will be 
made. 
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lAll'IF ® 0 implies an attempt to change attitude will not 
be made. 

SPECIAL INSTRUCTIONS: Punch a 0 or a 1 in column 3 of the 

data card. 

UNITS: (none) 

FORMAT: ’# 5000 « (IX, 12) 

IB2F: 

IB2F is the body 2 flag. (i.e. the elevator flag) 

IB2F *» 1 implies body 2 will be present. 

IB2F = 0 implies body 2 will not be present. 

SPECIAL INSTRUCTIONS: Punch a 0 or a 1 in column .3 of 

the data card. 

UNITS : (none) 

FORMAT: # 5000 - (IX, 12) 

IPOCK : 

ID0CK is the docking flag. 

IDOCK 83 1 implies docking will occur. 

IDOCK = 0 implies docking will not occur. 

SPECIAL INSTRUCTIONS: Punch a 0 or a 1 in column 3 of 

the data card. 

.UNITS: (none) 

FORMAT: # 5000 = (IX, 12) 

ZS&S&s 

ID0F(J) ° 0 implies the Jth controller aboard body 0 is 
a reaction wheel. 
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IDO]j'(J) =3 x implies the Jth controller aboard body 0 is a 
one degree of freedom control momint gyro, 

IDOF(J) ■=• 2 implies the Jth controller aboard body 0 is a 
two degree of freedom control moment gyro, 

SPECIAL INSTRUCTIONS: Punch a 0, 1, or a 2 in column 3 

of the data card. 

UFJ TS : (none) 

FORMAT: # 5000 » (IX, 12) 

I GRAVE .* • 

IGRAVF is the gravity gradient flag. 

IGRAVF « 1 implies gravity gradient torques will be present, 

IGRAVF 13 O’ implies gravity gradient torques will not be 
present. 

SPECIAL INSTRUCTIONS.; Punch a 0 or a 1 in column. 3 of 
the data card. 

UNITS : (none) 

FORMAT: # 5000 « (IX, 12) 

IPNDLM : 

IPNDLM is the pendulum flag. 

IPNDLM “ 1 implies body 3 and body 4, the .pendulums, 
will be present. 

IPNDLM = 0 implies body 3 and body 4, the pendulums, 
will not be present. 

SPECIAL INSTRUCTIONS: Punch a 0 or a 1 in column 3 of 

the data card. 

UNITS: (none) 

FORMAT: # 5000 » (IX, 12) 
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IPRINT: 


IPRINT is an Integer variable used to determine how often 
output data is printed. Data is printed in time increments 
of IPRINT * DELTAT. For example, if IPRINT = 50 and DELTAT » .2, 
then data will be printed when time = 10, 20, 30, 40, 50, . . . . 

SPECIAL INSTRUCTIONS; If IPRINT has a value -less than 10, 
punch the integer in column 3 of the data card. If IPRINT has a 
value greater than 9, punch the Integer in columns 2 and 3. 

UNITS: (none) 

✓ 

FORMAT : # 5000 » (IX, 12) 


IPROPF: 


IPROPF is the propulsion flag. 

IPROPF = 1 Implies propulsion forces will be considered. 

IPROPF =* 0 Implies propulsion forces will not be considered, 

SPECIAL INSTRUCTIONS: Punch a 0 or a 1 in column 3 of 

the data card. 

UNITS: (none) 

FORMAT: # 5000 - (IX, 12) 


NDECK : 

NDECK is an integer variable equal to the number of data 
decks present at run time. 

SPECIAL INSTRUCTIONS: This variable goes in front of the 

first data deck only. If NDECK has a value less than 10, 
punch the integer in column 3 of the data card. If NDECK 
has a value greater than 9, punch the integer in col umns 2 
and 3. 

UNITS: (none) 

FORMAT: # 5000 = (IX, 12) . 
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NGAIN 


NGAIN is an integer variable and refers to the number of 
arbitrary gains which are input. If NGAIN 13 3 then values, 
for GAIN(1), GAIN(2) and GAIN(3) will be input. The maximum 
value of NGAIN is 10. 

SPECIAL INSTRUCTIONS: If NGAIN has a value less than ’’ 

10, punch the integer in column. 3 of the data card. Otherwise, 
use columns 2 and 3. 

UNITS : (none) 

' FORMAT: # 5000 « (IX, 12) 

NUMCMG: 


NUMCMG is the number of controllers aboard body 0, A 
maximum of 6 controllers may be used. 

SPECIAL INSTRUCTIONS: Punch the integer in column 3 of 

the data card. 

UNITS: (none) 

FORMAT: # 5000 ■ (IX, 12) 


0MEGA1: 


0MEGA1 is the initial relative angular velocity measure 
about the spin axis between bodies 0 and 1. Another definition 
of OMEGA1 can be visualized by referring to the sketch shown 
below showing the orthogonal coordinate systems located on 
bodies 0 and 1. 


A 


*1 
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Implicit in this sketch is the hinge line between the stator 
and roto : is aligned parallel to both the Xq and X., axes. There- 
fore, the orientation of the stator and^the U rotor differ only 
In a- rotation Q « THETA1 and OMEGA 1 “ 0^ 

UNITS: (radians per second) 

FORMAT: # 5006 - (IX, FI 1.5) 


QHEGA3 : • 

0MKGA3 Is the angular velocity of body 3 about the hinge 
line 5 OMEGA3 is also the time derivative of_THETA3 when 
the datum for the angle THETA3 will be the Y., Z- plane as 


illustrated below: 





In other words, s, determines the positive direction of 
rotation by the right hand rule and the positive Y^ - 
plane determines to starting position. 

UNITS: (radians per second) 

FORMAT: # 5006 = (IX, F11.5) 


INITIAL VALUE AT TIME « T 


start 


OMEGA4 : 

0MEGA4 is the angular velocity of body 4 about the hinge 
line a, . 0MEGA4 is also the time derivative of TEEXA4 where 
the datum- for the angle THETA4 is the same as THETA3. (See 
0MEGA3) 

V 

UNITS: (radians per second) 
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FOEMAT ; # 5006 = (IX, Fll.5) 

INITIAL VALUE AT TIME ® T . . 

start 

PEND3L: 

PEND3L is the scalar distance from the hinge Line, s^, to 
-the center .of mass of body 3. (i.e, the length of pendulum 3) 

UNITS: (feet) 

FOEMAT: # 5006 * (IX, Fll.5) 


PENP4L : 

PEND4L is the scalar distance from the hinge line, s^, to 
the center of mass of body 4. (i.e. the length of pendulum. 4) 

UNITS : (feet) 

FOEMAT: # 5006 » (IX, Fll.5) 


S: 


S is a scalar parameter used in defining the position of 
body 2. S defines the magnitude of displacement «>f body 2 from 
the zero position. 

Note: Punch the value of S in columns 2 through 12. 

UNITS: (feet) 

FOEMAT: # 5002 * (IX, 3 (Fll.5, 2X)) 

INITIAL VALUE AT TIME = T . „ 

start 


SPOT : 

SPOT defines the magnitude of the velocity vector of body 2. 
Note: Punch the value of SPOT in columns 15 through 25. 

UNITS; (feat per second) 
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, FORMAS! : # 5002 * (IX, 3(P11.5, 2X)) 
INITIAL VALUE AT TIME » T gtart 


S Pi 


SP Is the desired spin magnitude of body 1 relative to 
body 0. 

UNITS: (radians par second) 

FORMAT: # 5006 - (IX, PH. 5) 

52 CM) : 

S2(l), S2(2), and 32(3) are the X, X, and Z components of 
a unit vector defining the direction of travel of body 2. 
is expressed in body 1 coordinates. 

UNITS: (none) 

•FORMAT: *# 5002 * (IX, 3(Fll.5, 2X)) 

S3(M) : 

S3(l), S3 (2), and S3 (3) are the X, Y, and Z components of 
a unit vector which defines the hinge line of body 3. is 
expressed in body 1 coordinates, S3(l) must always be zero. 

UNITS : (none) 

FORMAT: # 5002 = (IX, 3 (Pll. 5, 2X)) 


S4(M) : 

S4(l) j S4 (2 ) , and S4(3) are the X, Y, and Z components of 
a unit vector whieh defines the hinge line of body 4. s, is 
expressed in body 1 coordinates, S4(l) must always be zero, 

UNITS : (none) 

FORMAT: # 5002 « (IX, 3(F11.5, 2X)> 
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THATA(J) ; 


THAT.(J) Is the gimbal angle of the Jth controller aboard body 
0 assuming this controller is either a one or two degree of free- 
dom control moment gyro. If it is a two degree of freedom CM3, 
then this variable' refers to the inner gimbal angle. J may have 
a maximum value .of 6. 

UNITS: (radians) 

;FOB&ATj # 5006 ” (IX, F11.5) 

INITIAL VALUE AT TIME = T . , 

start 

TBATAD(J) ; 

THATAD(J) is the gimbal rate associated with THATA(J). 

UNITS: (radians per second) 

FORMAT: # 5006 ■» (IX, F11.5) 

INITIAL VALUE AT TIME » T ’ „ 

start 

THETAl : 

THEIAl is the relative angular displacement measured about 
the spin axis, between bodies 0 and 1. 



UNITS: (radians) 

FORMAT; # 5006- (IX, F11.5) 

INITIAL VALUE AT TIME — T . 

start 


A-19 



' TIUSTA3 j 


THETA3 is the angle between pendulum 3 and th<- Y,_Z, plane. 
The axis about which THETA3 rotates Is the hinge l..ne s,. For 
an explanation of the THETA3 datum refer to the discussion of 
0MEGA3 . 

UNITS : (radians ) 

FORMAT; # 5006 *» (IX, Fll.5) 

INITIAL VALUE AT TIME = T . 

start 

THETA4 : 

THETA4 is the angle between pendulum 4 and the Y, 2, plane. 
The axis about which THETA4 rotates is the hinge line s , . The 
datum for THETA4 is the same as for THETA3. 

UNITS; (radians) 

FORMAT; # 5006 « (IX, Fll.5) 

INITIAL VALUE AT TIME = T . 

start 

TIBOI (M,N) ; 


[TIB0I(M,N)] 


TIBOI (1,1) 
TIBOI (2,1) 
TIBOI (3,1) 


TIB0I(1,2) 
TIBOI (2,2) 
TIBOI (3, 2) 


TIBOI (1,3) 
TIBOI (2,3) 
TIBOI (3,3) 


This array is the initial transformation matrix of the 
body 0 coordinate system to the inertial coordinate system. 
If initially body 0 is aligned with the inertial system, 
TIBOI (M,N) would be the identity matrix. Refer to the 
coordinate . transformation appendix for further details. 

UNITS; (none) 

FORMAT: # 5006 = (IX, Fll.5) 

INITIAL VALUES AT TIME « T . . 

start 
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TSTART: 


TSTART is the time at which you wish the program to start 
calculating the equations of motion. Except for rastarting, 
TSTART is usually set to zero, 

SPECIAL INSTRUCTIONS : Punch the value of 1ST iRI in columns 

2 through 12. 

UNITS: (seconds) 

FORMAT: # 5002 « (IX, 3(F11.5, 2X)) 


TSTOP : 

TSTOP is the time at which you wish the program to stop 
calculating. 

SPECIAL INSTRUCTIONS: Punch the value of TSTOP in columns 

15 through 25. 

UNITS: (seconds) 

FORMAT: # 5002 = (IX, 3(F11.5» 2X)) 


WO(M) : 

W0(1), WO (2), and WO (3) are the X, X, and Z components 
of the angular velocity vector of body 0. 

UNITS: (radians per second) 

FORMAT: # 5002 « (IX, 3(F11.5, 2X),) 

INITIAL VALUES AT TIME =■ T „ 

start 
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GENERAL INPUT VARIABLES 


ALT: 


ALT is altitude of the center of mass of the space station 
configuration measured from the surface of the earth. All 
orbits are constrained to be circular with no ob lateness effects. 
Therefore, altitude is the. only pertinent orbit parameter. 

UNITS: (miles) 

FORMAT: # 5004 » (IX, Ell. 4) 


BDMASS : 

BDMASS is the sura of the mass of body 0, the stator, and 
the mass of the docking vehicle. The docking vehicle is con- 
strained to dock on body 0, the stator. BDMASS * 

UNITS: (slugs) 

FORMAT: # 5004 - (IX, Ell. 4) 


BODYDI (M,N) : 


[B0DYDI(M,N)] «* [i D ] 


BODYDI (1,1) 
BODYDI (2,1) 
BODYDI (3,1) 


BODYDI (1,2) 
BODYDI (2,2) 
BODYDI (3,2) 


B0DYDI(1,3) 
BODYDI (2, 3) 
BODYDI (3,3) 


This array is the inertia matrix of the 
consists of the docking vehicle connected to 


docked body which 
the stator. 


UNITS: (slug-ft 2 ) 


FORMAT: # 5004 - (IX, Ell. 4) 
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CA(K) : 

GA(1), CA(2), and CA(3) are the three direction cosines 
of the desired attitude reference direction in the inertial 
frame. 

UNITS: (None) 

FORMAT: # 5002 » (IX, 3(F11.5, 2X)) 


CPI and CP2 : 

CPI and CP2 are parameters used in determining the stiff- 
ness and the resonant frequency of the pendulums. Fox example, 
the control laws which are governed by the parameters are; 

T13 = - CPl * OMEGA3 - CP2 * THETA3 

T14 o - CPI * 0MEGA4 - CP2 * (THETA4 - ir) 

Note: These variables are read on separate data cards. 

UNITS : (none) 

FORMAT: # 5004 - (IX, Ell. 4) 


DD01(M) : 

DD01(1), DD01(2), and DD01(3) are the X, Y, ani Z componants 
of the vector from the center of mass of the docked body to the 
hinge line of body 1, the rotor. The vector is expressed in 
body 0 coordinates. The docked body shall be defined as the 
configuration of the docking vehicle attached to body 0. 

UNITS: (feet) 

FORMAT: 4 5002 « (IX, 3(FU,5, 2X)) 
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DELTAS); 


DELTAT ■ At 

DELTA! 1b the time increment used In the integration 
algorithm' which solves the rotational equations of motion. 

When "TIME" is updated we have: 

TIME - TIME + DELTAT 

Note: Punch the value of DELTAT in columns 28 through 38. 

UNITS: (seconds) 

FOEMAT: # 5002 - (IX, 3(FU.5, 2X)) 

PTI(M) : 

DTI(l), DTI (2) and DTI (3) are the X, Y, and Z components 
of the docking torque impulse. 

UNITS: lb-ft-sec 

FORMAT: # 5002 « (IX, 3(Fll»5, 2X)) 


DTIME : 

DTIME is the time when docking occurs. (i.e. 
The restrictions placed on DTIME are as follows: 


a) 


T . < DTIME < T 

start atop 


b) DTIME must be an integer multiple of At, 
■ UNITS: (seconds) • 


"Docking Time") 


FORMAT: # 5006 «=* (IX, F11.5) 
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GAIN (M) ; 

GAIN (M) is an array of numbers the dimension, of which is 
determined by another input variable NGAIN. These numbers, 
once read in, are stored in common and can' be used for a variety 
of purposes. In many CMG control laws it is necessary to have 
control gains. GAIN(M) can be used for this purpose among others. 

UNITS: (None) 

FORMAT: # 5004 « (DC, Ell. 4) 


IATTIF ; 

IATTIF is the attitude flag. 

IATTIF = I implies an attempt to change attitude will be 
made. 

IATTIF “ 0 implies an attempt to change attitude will not 
be made. 

SPECIAL INSTRUCTIONS; Punch a 0 or a 1 in column 3 of the 
data card . 

UNITS : (none) 

FORMAT: # 5000 = (IX, 12) 

IB2F : 

IB2F is the body 2 flag. (i.e. the elevator flag) 

IB2F = 1 implies body- 2 will be present. 

IB2F = 0 implies body 2 will not be present. 

SPECIAL INSTRUCTIONS: Punch a 0 .or a 1 in column 3 of 

the data card. 

UNITS : (none) 

FORMAT: # 5000 = (IX, 12) 
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IDOCK: 


I DOCK is the docking flag. 

IDOCK = 1 implies docking will occur. 

IDOCK *= 0 implies docking will not occur. 

SPECIAL INSTRUCTIONS: Punch a 0 or a 1 in column 3 of 

the data card. 

UNITS: (none) 

FORMAT: # 5000. = (IX, 12) 

IGRA.VF : 

I GRAVE is the gravity gradient flag. 

IGRAVF = 1 implies gravity gradient torques will be present. 

IGRAVF = 0 implies gravity gradient torques will not be 
present. 

SPECIAL INSTRUCTIONS: Punch a .0 or a 1 in column 3 of 

the data card. 

UNITS : (none) 

FORMAT: # 5000 = (IX, 12) 

IPNDLM ; 

IPNDLM is the pendulum flag. 

IPNDLM = 1 implies body 3 and body 4, the pendulums, 
will be present. 

IPNDLM = 0 implies body 3 and body 4, the pendulums, 
will not be present. 

SPECIAL INSTRUCTIONS: Punch a 0 or a 1 in column 3 of 

the data card. 

UNITS: (none) 

FORMAT: # 5000 = (IX, 12) 
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IPRINT: 


IPRINT is an integer variable used to determine how often 
output data is printed. Data is printed in time increments 
of IPRINT *• DELTAT. For example, if IPRINT 13 50 and DELTAT » .2, 
then data will be printed when time » 10, 20, 30, 40, 50, . 

SPECIAL INSTRUCTIONS: If IPRINT has a value le,is than io, 
punch the Integer in column 3 of the data card. If '.'.PRINT has a 
value greater than 9, punch the integer in columns 2 and 3, 

UNITS: (none) 

FORMAT: # 5000 = (IX, 12) 


IPKOPF : 

IPROPF is the propulsion flag. 

IPROPF » 1 implies propulsion forces will be considered. 

IPROPF a 0 implies propulsion forces will not be considered. 

SPECIAL INSTRUCTIONS: Punch a 0 or a 1 in column 3 of 

the data card. 

UNITS: (none) 

FORMAT: # 5000 » (IX, 12) 


NDECK : 

NDECK. is an integer variable equal to the number of data 
decks present at run time. 

SPECIAL INSTRUCTIONS: This variable goes in front of the 

first data deck only. If NDECK has a value less than 10, 
punch the integer in -column 3 of the data card. If NDECK 
has a value greater than 9, punch the integer In columns 2 
and 3 . 

UNITS: (none) 

FORMAT: 5000 - (IX, 12) 
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NGAIN 1 


NGAIN la an integer variable and refers to the lumbar of 
arbitrary gains which are input. If NGAIN ■ 3 then values 
for GAIN(l), GAIN (2) and GAIN(3) will be input. The maximum 
value 'of NGAIN is 10. 

SPECIAL INSTRUCTIONS i If NGAIN has a value less than 
10, punch the Integer in column 3 of the data card. Otherwise, 
use columns 2 and 3. 

UNITS: (none) 

FORMAT: # 5000 •= (IX, 12) 


TSTART : 

TSTART is the time at which you wish the program to start 
calculating the equations of motion. Except for restarting, 
TSTART is usually set to zero. 

SPECIAL INSTRUCTIONS: Punch the value of TSTART in columns 

2 through 12. 

UNITS: (seconds) 

FORMAT: # 5002 ~ (IX, 3(F11.5, 2X)) 


TSIOP: 

TSIOP is the time at which you wish the program to stop 
calculating. 

SPECIAL INSTRUCTIONS: Punch the value of TSTOP in columns 

15 through 25. 

UNITS: (seconds) 

FORMAT: # 5002 » (IX, 3(F11.5, 2X)) 


A-28 



• BODY 0 INPUT VARIABLES 


[aII(J,M,N)| : 


[AII(J,M,N)] 



AII(J,1, 1) 
AII(J,2,1) 
All (J, 3,1) 


AII(J,1,2) • 
All (J, 2, 2) 
All (J, 3, 2) 


AII(J,1,3) 
All (J,2,3) 
AII(J,3,3) 


This array is the inertia matrix for the inner gimbaL of 
the Jth control moment gyro aboard the stator. A maximum of 
six CMGs may be used. (i.e. J = 1,6) All CMGs>are also con- 
strained to be located at the center of mass on the stator, body 
0. If the Jth CMG has one or two degrees of freedom, it will 
have an inner' gimbal. '(Refer to the write up on CMGs for further 
discussion. ) 

UNITS: (slug -ft 2 ). 

FORMAT:. # 5006 = (1X,.F11.5) 


AI0(J,M,N) ; ’ 


[AI0(J ,M,N)] = [lOj] = 


■ AI0(J,1, 1) 
AIO (J,2, 1) 
AIO (J,3, 1) 


AI0(J,1,2) 
AIO(J,2,2) 
AIO (J, 3, 2) 


AI0(J, 1,3) 
AIO (J ,-2,3) 
AIO (J, 3, 3) 


This array is the inertia matrix for the outer gimbal of 
the Jth control moment gyro aboard the stator. A maximum of 
six CMGs may be used. (i.e. J a 1,6) All CMGs are constrained 
to be located at the center of mass on the stator, body 0. The 
Jth CMG will have an outer gimbal only if it has two degrees of 
freedom. (Refer to the write up on CMGs for further discussion.) 

2 

.UNITS: (slug-ft ) 

FORMAT: # 5006 = (IX, Fll.5) 
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ACCJ(J.M.N) : 


[AOCJ(J,M,N)] 



AOCJ (J , 1, 1) 
AOCJ (J,2,l) 
AOCJ (J, 3,1) 


AOCJ (J, 1,2) 
AOCJ (J, 2,2) 
AOCJ (J, 3,2) 


AOCJ <J, 1,3) 
AOCJ (J,2,3) 
AOCJ (J,3,3) 


This array is the coordinate transformation matrix from the 
CMG null gimbal coordinate frame to the coordinate frame of body 
0, the stator. (Refer to the coordinate transformation appendix.) 
For example, consider the two coordinate systems shown below: 



Body 0 Frame 


Z J 



Jth Null Gimbal Frame 


For the above situation: 


[AOCJ (J,M,N)] 


UNITS : (None) 


0 . 0 . 1 . 

1 . 0 . 0 . 

0 . 1 . 0 . 


FORMAT: 


# 5006 


(IX, F11.5) 




AOJ(M) : 


AOJ(l) is the distance between the jets of the pure couple 
producing the torque around the X axis of body 0. 

AOJ(2) is the distance between the jets of the pure couple 
producing the torque around the Y axis of body 0. 

AOJ (3) is the distance between the jets of the pure couple 
producing the torque around the Z axis of body 0. 

Note: The variables CGAINO (1) , CGAINO (2), and CGAIN0(3) 

are also read on the same data cards as AOJ(l), 

AOJ (2), and AOJ (3). punch the values of AOJ (1) , 
AOJ (2), and AOJ (3) in columns 2 through 12 of the 
data cards . 

UNITS: (feet) 

FORMAT: '# 5008 - (IX, Ell. A, 2X, Ell. 4) 


BODYOX (M,N) : 


[bODYOI (M,N)] = 



BODYOI (1,1) 
BODYOI (2,1) 
BODYOI (3,1) 


BODYOI (1,2) E0DY0I(1,3) 

BODYOI (2, 2) BODYOI (2, 3) 
BODYOI (3 ,2) BODYOI (3,3) 


This array is the inertia matrix of body 0, the stator, 
UNITS:- (slug-ft 2 ) 

FORMAT: # 5004 - (IX, Ell. 4) 


BOMASS : 

BOMASS is the mags of body 0, the stator. BOMASS 13 ra ( 
UNITS: (slugs) 

FORMAT: # 5004 « (IX, Ell. 4) 


A-31 




CGAINO (1) equals the control gain of all four reaction 
jets In the. pure force couples producing torque around the X 
axis of body 0. , 


CGAINO (2) equals the control gain of all four reaction 
jets In the pure force couples producing torque around the Y 
axis of body 0. 

CGAINO (3) equals the control gain of all four reaction 
jets In the pure force couples producing torque around the Z 
axis of body 0. 

Note: The variables A0J(1), A0J(2), and AOJ<3) are also 

read in on the same data cards as CGAINO (1), 
CGAINO (2 ) , and CGAINO (3), Punch the values of 
CGAINO (1) , CGAINO (2 ) , and CGAIN0(3) in columns 
15 through 25 of the data cards. 

UNITS: (Lb /rad Ians /second ) 


FORMAT: # 5008 « (IX, Ell. 4, 2X, Ell. 4) 


FEE(J) : 

FEE(J) » 0j 

FEE(J) is the outer glmbal angle of a two degree of freedom 
control moment gyro as shown pictorlally below: 



The subscript J refers to the number assigned to the CMS. 
(Refer to the write up on CMGs for further discussion.) 

UNITS: (radians) 

FORMAT: # 5006 - (IX, Fil.5) 

INITIAL VALUE AT TIME » ^ Btavt 
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FEED(J). : 


FEE1>(J) “ 0j 

FEED(J) is the outer gimbal rate of a two degree of freedom 
control moment gyro. The subscript J refers to the number 
assigned to the CMG. (Refer to the write up on CMGs for further 

discussion.) 


UNITS: (radians /second) 
FORMAT: # 5006 = (IX, Fll.5) 


HHf(J) : 

Hff(J) is the angular momentum of the wheel associated with 
the Jth momentum device. (Refer to the write up on CMGs for 
further discussion.) 

■ 2 

UNITS: (slug-ft /second) 

FORMAT: # 5004 * (IX, Ell. 4) 


IDOF(J) : 

IDOF(J) “ 0 implies the Jth controller aboard body '0 iB 
a reaction wheel. 

IDOF(J) “ 1 implies the Jth controller aboard body 0 is a 
one degree of freedom control moment gyro. 

ID0F(J) = 2 implies the Jth controller aboard body 0 is a 
•two degree of freedom control moment gyro. 

SPECIAL INSTRUCTIONS: Punch a 0, 1, or a 2 in column 3 

of the data card. 

UNITS: (none) 

FORMAT: # 5000 « (IX, 12) 
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NUMCMG : 

NUWCMG is the number of controllers aboard body 0. A 
maximum of 6 controllers may be used. 

SPECIAL INSTRUCTIONS: Punch the integer in column 3 of 

the data card. 

UNITS : (none) 

FORMAT: # 5000 » (IX, 12) 


THATA(J) : 

THAT(J) Is the gimbal angle of the Jth controller aboard body 
0 assuming this controller is either a one or two degree of free- 
dom control moment gyro. If it is a two degree of freedom CMC* 
then this- variable refers to the Inner gimbal angle. J may have 
a maximum value of 6. 

UNITS : (radians ) 

FORMAT; # 5006 » (IX, Fll.5) 

INITIAL VALUE AT TIME « T . 

start 


THATAD(J) : 

TKATAD(J) is the gimbal rate associated with THATA(J) . 
UNITS: (radians per second) 

FORMAT: # 5006 - (IX, Fll.5) 

INITIAL VALUE AT TIME = f gtart 
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TIBOI (M,N) : 


[tiboi (m,n)] 


TIBOI (1,1) 
TXBOI (2 , 1) 
TIBOI (3,1) 


TIB0I(1,2) 
TIBOI (2,2) 
TXBOI (3,2) 


TXBOI ;i,3) 
TIBOI (2,3) 
TIBOI (3,3) 


This array is the initial transformation matrix of the 
body 0 coordinate system to the inertial coordinat i system. 
If initially body 0 is aligned with the inertial system, 
TIBOI (M,N) would be the Identity matrix. Refer 10 the 
coordinate. transformation appendix for further details. 

UNITS: (none) 

FORMAT: # 5006 * (IX, F11.5) 

INITIAL VALUES AT TIME = T . . 

start 


W0(K) : 

W0(1), WO (2), and WO (3) are the X, Y, and Z components 
of the angular velocity vector of body 0. 

UNITS: (radians per second) 

FORMAT: # 5002 ° (IX, 3(F11.5, 2X)) 

‘ INITIAL VALUES AT TIME » T t 

start 
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BODY 1 INPUT VARIABLES 


AlJ<M) : 

A1J(1) is the distance between the jets of the pure couple 
producing the torque around the X axis of body 1, 

AlJ (2) is the distance between the jets of -the pure couple 
producing the torque aromul the Y axis of body 1, 

Note: The variables CGAINl(l) and CGAIN1(2) are also 

read on the same data cards as A1J(1) and AlJ (2). 
Punch the values of A1J(1) and AlJ (2) in columns 2 
through 12 of the data cards. 

UNITS: (feet) 

FORMAT: # 5008 « (IX, Ell. 4, 2X, Ell. 4) 


BODYII(M.N): 


[bODY 1I(M,N)] - [ijJ 


B0DY1I(1,1) B0DY1X(1,2) 
BODYlI (2,1)^ BODYlI (2,2) 
BODYlI (3,1) BODYlI (3 ,2) 


BODYlI (1,3) 
B0mi(2,3) 
BODYlI (3, 3) 


This array is the inertia matrix for body 1, the rotor. 
UNITS: (alug-ft 2 ) 


FORMAT: # 5004 » (IX, Ell.4) 


BLMASS : 

BlMASS is the mass of body 1, the rotor. BlMASS = 
UNITS: (slugs) 

FORMAT: # 5004 « (IX, Ell.4) 
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CGAINI(M) : 

CGAIN1(1) equals the control gain of all four reaction 
jets in the pure force couples producing torque around the X 
axis of body 1. « 

CGAIN1(2) equals the control gain of all four reaction 
jets in the pure force couples producing torque around the Y ; , 
axis of body 1. 

Note; The variables A1J(1) and A1J>(2) are also read 

in on the same date cards as CGAlNl(l) and CGAIN1(2). 
Punch the values of- CGAIN1(1) and CGAIN1(2) in 
columns 15 through 25 of the data cards. 

UNITS: (lb/radlang/second) 

FORMAT:. # 5008 - (IX, Ell. 4, 2X, E11.4) 


SO KM) : 

D01(l), D01(2), and D0I(3) are the X, Y, and Z components 
of the vector from the center of mass of body 0 to the hinge 
line of body 1, .the rotor. The vector is expressed in body 0 
coordinates . DOl^l^) should in most cases be zero. 

UNITS: (feet) & 


FORMAT: # 5002 - (IX, 3 (FI 1.5, 2X)) 


0MEGA1 : 


0MEGA1 is the initial relative angular velocity measure 
about the spin axis between bodies 0 and 1. Another definition 
of 0MEGA1 can be visualized by referring to the sketch shown 
below showing the orthogonal coordinate systems located on 
bodies 0 and 1. 




h 
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Imp iolt in this sketch is the hinge lino between the stator 
end roto • is aligned parallel to both the X Q and X, axes. There- 
fore, th". orientation of the stator and 4 the°rotor differ only 
in a rot ition 6^, « THETA1 and OMJEGAl » 6^, 

UNIJS: (radians per second) 

FORMAT s # 5006 «= (IX, Fll.5) 


SP: 

SP Lb the desired spin magnitude of body 1 relative to 
body 0, 

UH3 ES: (radians per second) 

FORMAT: # 5006 = (IX, Fll.5) 

THETAl t 

THEXA1 is the relative angular displacement measured about 
the spin axis, between bodies 0 and 1. 



UNITS: (radians) 

FORMAT; # 5006= (IX, Fll.5) 
INITIAL VALUE AT TIME - T 

start 
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BODY 2 INPUT VARIABLES 


B2MASS ; 

B2MASS is the mass of body 2, the elevator. B2MASS « m 2 
UNITS: (slugs) 

FORMAT: tf 5004 - (IX, Ell. 4) 


P12 (M) ; 

Dl2(l), Dl2(2) and Dl2(3) are the X, Y and Z components of 
a fixed vector locating the. starting position of the movable’ 
mass, the elevator. The vector equation that describes the 
motion of the movable mass is jL ® d 12 + iLs. Where s_ is a 
unit vector which defines the direction in which the movable 
mass travels and a is a scalar prespecified function of time. 
For most cases s(t Q = 0) = 0 so that dj* specifies the Initial 
starting position of the movable mass.^Ehe elevator is known 
alternately as the movable mass or body 2. D12 is expressed 

in body 1 coordinates. For example, if the elevator were con- 
strained to travel along the X axis, then 3 .. could have the 
following values: D12(1) = 1., D12(2) » 0., D12(3) » 0. 

UNITS: (feet) 

FORMAT: # 5002 » (IX, 3(F11.5, 2X)) 


S: 


S is a scalar parameter used in defining the position of 
body 2. S defines the magnitude of displacement of- body 2 from 
the zero position. 

Note; Punch the value of S in columns 2 through 12. 

UNITS: (feet) 

FORMAT: # 5002 = (IX, 3(F11.5, 2X)) 

INITIAL VALUE AT TIME = T . 

start 
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SHOT: 


SDOT defines the magnitude of the velocity vector of body 2. 
Note: Punch the value of SDOT in columns IS through 25. 

UNITS: (feec per second) 

FORMAT! # 5002 - (IX, 3(F11.5, 2X>) 

INITIAL VALUE AT TIME - T 

start 

S2M: 

S2(l), S2(2), and S2(3) are the X, Y, and Z components of 
a unit vector defining the direction of travel of body 2, 
is expressed in. body 1 coordinates. 

UNITS (none) 

FORMAT: # 5002 » (IX, 3 (*11.5, 2X)) 
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BODY 3 INPUT. VARIABLES 


B3MASS: 

B3MASS is the mass of body 3, a pendulum. B3WASS “ m^ 
UNITS: (s lugs ) 

‘ FORMAT: # 5004 ” (IX, Ell. 4) 


D13(M) : 

Dl3(l), D13(2), and Dl3(3) are the X, Y, and Z components 
of the vector from the center of mass of body 1 to :he hinge 
line of body 3. 5X3 is expressed in body 1 coordimtes. 

UNITS: (feet) 

FORMAT: # 5002 “ (IX, 3(Fll.5, 2X)) 


0MEGA3: 


0MEGA3 Is the angular velocity of body 3 about the hinge 
line s„. OMEGA3 is also the time derivative of__THEXA3 when 
the datum for the angle THETA3 will be the Y-, Z. plane as 
illustrated below.: 


^ * 3 <t> 





In other words, s« determines the positive direction, of 
rotation by the right hand rule and the positive Y 1 - Z- 
plane determines to starting position. 


UNITS: (radians per second) 

FORMAT: # 5006 » (IX, F11.5) 

INITIAL VALUE AT TIME = T . 

s tart 
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PEND3L 


PKND3L la tlio scalar distance from the hinge linn, jL, to 
the canter of iiwno of body 3. (l.e. the length of pendulum 3) 

' UNITS: (feet) 

FORMAT: # 5006 *=» (IX, FIX. 5) 


S3(l), S3 (2), and S3 (3) axe the X, Y, and Z components of 
a unit vector which defines the hinge line of body 3, HL is 
expressed in body 1 coordinates. S3(l) must always be zero. . 

UNITS : (none) 

FORMAT: # 5002 » (IX, 3(F11.5, 2X)) 

THETA3 : 

-THETA3 is the angle between pendulum 3 and the Y, Z, plane. 
The axis about which THETA3 rotates is the hinge line *L. For 
an explanation of the THETA3 datum refer to the discussion of 
0MEGA3. 

UNITS : (radians ) 

FORMAT: # 5006 « (IX, F11.5) 

‘INITIAL VALUE AT TIME = T . 

start 
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BODY 4 INPUT VARIABLES 


B4MASS : 

B4MASS is the mass of body 4, a pendulum. B4MASS » 
UNITS: ' (slugs) 

FORMAT: # 5004 « (IX, Ell. 4) 

D14(M) : 

D14(1), D14(2) , and D14(3) are the X, Y, and Z components 
of the vector from the center of mass of body 1 to the hinge 
line of body 4, 

D14 is expressed in body 1 coordinates , 

UNITS : (feet) 

FORMAT: .# 5002 ~ (IX, 3 (FIX. 5, 2X)) 

OMEGAA : 

TOIEGA4 is the angular velocity of body 4 about the hinge 
line s, .. 0MEGA4 Is also the time derivative of THETA4 where 
the datum for the angle THETA4 is the same as THECA3. (See 
0MEGA3) 

UNITS: (radians per second) 

FORMAT: # 5006 * (IX, F11.5) 

INITIAL VALUE AT TIME ■ T 

start 

PEND4L : 

PEND4L is the scalar distance from the hinge line, i,, to 
the center of mass of body 4. (i.e. the length of pendulum 4) 

UNITS: (feet) 

FORMAT: # 5006 = (IX, Fll.5) 
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S4(l), S4(2), and S4(3) are the X, Y, and Z components of 
a unit vector which defines the hinge line of body 4. s, is 
expressed in body 1 coordinates . S4(l) must always be Zdro. 

UNITS.: (none) 

FOBMA.T: # 5002 « (IX, 3(F11.5, 2X>) 

/ 

THSTA4 : 

THETAA is the angle between pendulum 4 and the Y, Z, plane. 
The axis about which THETAA rotates is the hinge line s, . The 
datum for THETA4 is the same as for THEIA3, 

UNITS: (radians) 

FORMAT: # 5006 - (IX, Fll.5) 

INITIAL VALUE AT TIME “ T „ 

start 
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APPENDIX B, COORDINATE TRANSFORMATIONS 


The following pages contain a pictorial guide to aid the 
user in computing the initial transformation matrix from one 
right hand orthogonal coordinate system to another. The trans- 
formation matrix from coordinate system B to coordinate A shall 
be denoted [a,b] . 


Mathematically : 




i.e, X A = AB(1,1> * X B + AB(1,2) * + AB(1,3) * Z^ 

Y a = AB(2,1) * Xg + AB(2,2) * Y^ + AB(2,3) * Z^ 

Z k - AB(3,1) * Xg + AB(3,2) * Yg + AB(3,3) * Z^ 


For simplicity, the coordinate systems in the following 
illustrations are orthogonal to each other in one way or another, 
i.e. There are not small offsetting rotations. Hence, the 
components of A,B may assume only certain values. The com- 
ponents may be + 1., 0., + sin0, + cos0, + sin9, + cos9, + sintf, 
or + cos0 where 0, 9, and ]4 are angles of rotation about the 
X, Y, Z axes respectively. 
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RUNS* <P9**., *377777**1) 

LGO. 

EXIT* 

OMP* 

DMP(0»l50000) 

PROGRAM MD246 < XNPUT 9 oUTpUT 9 TAPE5oINPUT 9 TAP^oOUTPUt*F!lLMPU 
C * 

c * 

c # . 


COMMON 

A(3) 
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0 
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* COMMC 
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0MEGA4 
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4 
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* COMMC 

4 
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« 
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* COMMC 
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* COMMC 

4 

TIME * 
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* COMMC 

0 
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COMMC 
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TOEF (3) * 
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» COMMC 

0 
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TSUG(3) 

* COMMC 

4 

TQlP (3) » 

tsta«t , 
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* COMMC 
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TTIOOT * 

fT3D0,T * 

TT400T 

* COMMC 

# 

T1EF O) * 
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T14 

COMMC 

COMMON 

COMMON 
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WOO) * 

WS * 
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COMMC 
» COMMC 
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COMMC 
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CQMMC 

000*0##0*0000000«###00*#000*0#00000*0000**0*0*0<M*’<*0****«'******#***0*00« 
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c # 

c # 

C «H»****#*a*i***i#*###**####**###i»*##fc*#tf **###«***#**»#**###*#******#»*« 


c rCon 

C THIS IS THE ENTRY POINT TO THE RUN ConTROl MODULE* RCON 

C THE FUNCTION OF THIS MODULE IS TO M^KE THE DECISION TO STOP All RCON 

c calculations and exit the program or continue to the input module rcon 

c and read in the data for the next case, rcon 

C RCON 

NCHECK s- 0 rcon 
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oo ooooooooooo 


READ IN THE NUMBER OF DATA DECKS PRESENT AT RUN TIME# RCON 

READ (5,5000) NDECK RCON 

print ndeck on a new sheet of Paper. Rcon 

WHITE (6»60QQ) NOECK RCON 

THE program returns to the following STATEMENT number after each rcon 

DATA OECK HAS BEEN COMPLETELY PROCESSED. RCON 

10 NOHECK a NCHECK ♦ i RCON 

IF (NDECK ,GE. NCHECK) GO To 20 RC° N 

STOP RCON 

20 CONTINUE RCON 

Rcon. 

# 




c 

c 

c 

c 

c 

c 

c 

c 


THIS IS THE ENTRY POINT TO THE INPUT MODULE. 

the function of This module is to read in all data pertaining to 
The next case, after each variable has been READ in. it will be 
PRINTED OUT TO insure PROPER CONVERSION AnD TO RETAINi A RECORD OF 
THE INPUT DATA 0 

DO 25 Mai * 1 0 
GAJN(M) a 0. 

25 CONTINUE 

WHITE <6. 65oo> NCHECK 

Read the pendulum flag. 

READ (5,5000) XPNQLM 
WRITE (6,6002) IPNDLM 

READ THE PRINT FLA®* CltE. PRINT EV^RY IPRIN7 'Ti M £ POINT.) 

READ (5,5000) jPRlNT 
WKITE(6,65*4) IPRINT 

read the starting TIME, STOPING time, and deltat. 

READ (5,5002) TSTARTtTSTOP, DELTAT 
WRITE (696002) TSTaRT»TSTOP*DELTAT 

read the orbit altitude. 

READ (5,5o 0 A) Alt 
WRiTE(6,600A) AL 7 ’ 

read the transformation from the body o frame to the i frame. 

Du 30 Mai, 3 
DO 30 Nai»3 

READ (5,5006) TI80I(M»N) 

30 CONTINUE 

DO 35 Ms 1,3 

WRITE (6,6006) MoTlBOI (M,l) ,M,TIBOI (M,2) ,M,TIBOI (M»3) 

35 CONTINUE 

READ BODY o ANGULAR RATES, 

READ (5,5002) W0(l),W0(2) ,W0(3) 

WRIT£(6,6008> WOU> »WO<2) *W0(3> 

READ THE MASS OF BODY 0. 

Read (5,sgq4) bomass 
J 9 0 

WRjTE(6 9 6QIQ) JeBoMASS 

Reap The inertia matrix for body o. 

DO 40 Males 

Do 40 NbI ,3 

READ (5,5004) BODYOKM.n) 

40 continue 
DO 45 Mol *3 

WRITE (6,6012) MpBODTOI (M, 1 ) »M»90DYOI (m*2? ,M,B0DY0I (M,3) 

45 CONTINUE 
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INPU 

INPU 
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o o 


C 


C 


c 


c 


c 


c 


c 


READ THE NUMBER OF CONTROL MOMENT GYroS ABOARD BODY 0* 

READ (5,5000 ) NUMCH6 
WRITE<6,6oi4 ) nUMCMG 
XF (NUMCMG ,EQ* 0) 00 TO 120 
DO 110 J*1*NUMCMQ 

READ TH£ DEGREE OF FREEDOM OF THE JTh CMG, 

READ < 5 t 5 qoq> I DOF ( J) 

IF (IDOf(J) .NE* 0) GO TO 50 
«RITE(6,6016> J 
GO TO 7-0 

50 IF (IQOf(J) ,NE, 1 ) GO TO 60 
WRITE ( 6 , 6018 ) J 
GO TO ?0 

60 WHlT£(6 t 6020) J 
70 CONTINUE 

read the angular momentum of the jth cmg, 

READ (S,5Q04) HW ( J) 

WRIT£{ 6 , 602 H) UfHWW) 

read the TRANSFORMATION from the JTH null gimbal frame to body 
frame, 

00 8o M*1 ,3 
DU 80 Ns 1.3 

READ (5,5006) AOCJ(J,M«N) 

80 CONTINUE 
DO 85 Msl t3 

„ WRITE (6,6024) J*M,A0CJ(J»M,1) ,J,M,AOcj(J»M»2 ) *J*M,aOCU(J#M» 3) 
85 CONTINUE 

IF (IOOF(J) ,EQ, 0) GO TO HO 

Read the inertia matrix for the uth inner gimbal, 

DO 90 M*1 » 3 
00 90 N«l»3 

Read (5,soo6) aii<j*m,n) 

90 CONTINUE 
DO 95 M»l»3 

WRiTe (6, 6026) J,M,A^I (J»M»1> , J,M, AI I < j,M,2) » J»M* AI | ( J,M,3) 

95 CONTINUE 

READ THE Inner GImBAL AN 6 LE and RATE OF the jth CMg, 

REAO (5,5oo6) THAtA(J) 

Read (5»5oo6) thatad(j) 

WHITE (6,6028) J»ThATA(J> ,J,THATAD(J) 

FEE(J) a 0, 

FEED(J) » 0, 

IF (IDOF(U) ,EQ, 1) Go TO 110 

read the inertia matrix For the jth outer gimbal, 

00 100 M* 1 ,3 
DO loo N*l ,3 

READ (5,5006) AX0(J*M,N) 

100 continue 


00 105 M a l , 3 

WRITE (6, 6030) j*M, AlO < J,M, l) , J,M» AlO < J,M»2 > ,J,M,AlO( J,M,3) 
105 COnTinUe 

READ THE OUTER GlMBAL ANGLE AND RATE OF THE JTH CMg. 

REAO (5,5oo6) fEE(J> 

Read (5,5qo6) feed(O) 

, WRITE (6»6032) J*F£E( J) »J»FEED( J) 
iio CONTINUE 
120 CONTINUE 

READ THE PROPULSION FLAG. 

READ (5,SooO) JPRqPF 
WRiTe (6,6072) IPROPF 


IF (IPROPF ,EQ 
READ (5,5000) 


, 0) GO TO 140 

iattif 


0 
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no 


WHITE (6,6562) IATTIF 
IF (JATTIF ,EQ. 0) 00 TO 125 
READ (5 * BOOS) CAU) oCA(2> «CA(3> 

. WRXTE(6,6564) CA(i) # CA(2) 9 CA<3) 

125 CONTinDe 

DO 130 J«l*3 

READ (5,5000) AoJ(J)» CQAINO(J) 

W«XTe (6*6074) J»AOJ(J) 9 J 9 CGAI NO (J) 

UO CONTINUE 
UO CONTINUE 

c READ IN VARIABLES RELATED TO BODY lo 

c head The mass of body i • 

READ ( 5 i 5004) BIMaSS 
J a 1 

W«iTe(6,6010) JiBJMASS 
c READ THE INERTIA MATRIX FOR BODY 1* 

00 !5o m° t » 3 
DO 150 N«i 9 3 

READ (5,5004) B0DY1X(M 9 N> 

1&0 CONTINUE 

00 153 M=l 9 3 

WKlTE(6 9 6040) M 9 BOOYII (M ? l) ,M 9 B0DY1 I«m 9 2) 9 M?B0DY1I (M,3) 

153 CONTINUE 

c read the primary gimbal angle and raTf of body i w,r 9 t<, body o. 

READ (5 9 5U0S) THETAl 
READ <5,5oo6) OMEgAI 
WHt T E(6 9 6U42> ThETAUOMEGAI 

read the vector from the cm of body o to the hinge point between 
sody o and body 1® (BoOy o coordinates) 

read (5g50Q2) D01(l) 9001 (2) 9 DOH3) 

WHITE <6 9 6044) 001(1)9001(2) 9 001(3) 

c read the body 2 flag, u,e q the elevator flag*) 

Read (5,sooo> xb2f 
WRITE ( 6,6546) IB2F 
IF (182F .EQo O') GO To 155 
c head the mass of the elevaTqR 0 

READ (5« §004) B2MASS 

J s 2 

WR|Te(6gG010) JtS2MASS 

READ (5»5002) 012(1)', 03.2(2) eD12(3) 

WHITE (G, 6535) 012(1) 9012(2) 9 D12(3) 

READ (5,5002) 52(1) , S2<2), 52(3) 

J »- 2 

WRITE (6 9 G052) JsS2(1) ,J,S2(2> »J,S2(3) 

c Read the position and velocity of the elevator, 
read (5,5002) S 9 SD0T 
WRITE (6^6548) S 9 SOOT 
GO TO 15? 

155 B2MASS a Oo 
012(1) 9 O e 
012(2) 3 0, 

012.(2) a 0 0 
S2U) * Oo 
S2.<2) s 0, 

52(3) e 0, 

, SDOt s Oo 
S 3 0 e 

157 CONTINUE ' 

IF (IPRQPF 0 EOe 0) GO TO 170 
00 160 *1=1*2 

READ (5?5008) A-JUU)? CGA2NKJ) 

WRITE (6,6076) J,A1J(U) 9 J 9 CGAIN1 <J) 
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l&Q CONTINUE 
UO CONTINUE 

IF (IPnoLM ,eQ* 0) GO To 172 
READ (5,5004) CPI 
WRITE(6 e 6582) CPI 
READ (.5,5004) CP2 
WHITE (6,6584) CP2 

C READ THE VARIABLES ASSOCIATED WITH SODY 3 0 U#E° PENDULUM 3) 

C READ the MASS of BODY 3« 

READ (5,5004) B3MASS 
J a 3 

WH|TE(6,4010) U, 0 3MASS 

c «eao the Vector from the cm of body i To the hinge point between 

C BUOY 1 AND PENDULUM 3* (BODY 1 COORDINATES) 

READ (5,5002) D.I3 ( I ) »D13 (2 > ,013 (3) 

WHITE (6,6048) 013(1)9013(2)9013(3) 

READ (5,5002) §3(1), S3(2>* S3(3) 

J » 3 

WRjTe ( 6,6052) JfS3(l) ,J,S3<2) »J,$3(3) 
c- read the length op booy 3 , <i 0 e, pendulum 3) 

READ (5,5oo6) PENQ3L 
WRITE (6,6058) PEN03L 

C READ THE PRIMARY GXMBaL ANGLE OF BODY 3 W 0 R,T» BODY 1, 

READ (5,5oo6) THETA3 
WRITE (6,6060) THETA3 

C READ THE PRIMARY GXMBaL RATE OF BODY 3 W 0 R,T, BODY 1, 

READ (5,5006) 0MEGA3 
WRsTE(6,6068) OME0A3 

c read the variables associated with body 4, u e £* pendulum a) 

C' READ THE MASS OF BODY A, 

READ (5j5oo4) B4MASS 
U S A 

WRITE (6»6010) J^BAMASS 

C READ THE VECTOR FROM THE CM OF BODY 1 TO THE HINGE POINT BETWEEN 
C BODY 1 AND PENDULUM 4 # (BODY 1 COORDINATES) 

HEAD (5,5002) D14(1) 9014(2) ,D14(3) - 
WRITE (6,6050) 6l4( 1) 9014 (2) ,D14 (3) 

READ (5,5oo2) $4(1), $4(2), S4(3) 

J a 4 

WRITE (6,6052) J»$4U) ,J,S4(2) »J?S4(3) 

C READ THE LENGTH OF BODY 4. (I, £, PENDULUM 4) 

READ (5,5ooS) PEN04L 
WHlTg (6,6064) PEND4L 

C READ THE PRIMARY GXMBaL ANGLE AND RATf OF BODY 4 W,R,T, BODY 1. 
READ (5,5oo6) THETA4 
READ (5,5006) 0MEGA4 
WRITE (696066) THETA490MEGA4 
GO TO 174 
172 03mAss a 0, 

CPl « 0 a 

CR2 * 0, 

D13 ( 1 > a 0, 

Dl3 (2) « 0, 

0X3(3) a 0, 

§3(1) a 0, 

*3(2) a 0, 

53(3) a 0, 

PEnD3l s 0 o 
THETA3 = 0, 

0MEGA3 a 0« 

B4MASS a 0 o . 

014(1) a 0. 


INPUT 

INPUT 

input 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

input 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

input 

INPUT 

INPUT 

INPUT 

INPUT 

INPOT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

JNPUT 

INPUT 

INPUT 

INPUT 

INPUT 

input 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

jNPUT 

INPUT 

INPUT 

INPUT 
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DU<2> a 0, 

014(3) • 0, 

S*U> c 0. 

S4<2> « 0* 

S*(3) e 0* 

PEND4U B 0g 

THETAS • 0, 

0ME0A4 « 0* 

174 CONTINUE 

REAO (5»5qo6) 

WWjTe (6*6080) 

READ (5*5000) 

WHITE (6,6570) 

IF (NG/MN e EQ 
DO 175 J®1*NGAIN 
READ (5*5004) OAlN(J) 
WHITE(6 # 66?2> J*GAIN(J) 

175 CONTinU E 

176 CONTINUE 

READ THE GRAVITY GRADIENT 
READ (5,5ooO> IGKAVF 
WRITE (&*6078) IG R AVF 
READ THE DOCKING FLAG. 
READ (5*5000) IDOCK 
wHlTE (6*6068) IDOcK 


SP 

SP 

ngain 

ngAjn 

, 0) eo 


TO lT6 


flag, 


I DOCK 9 1 IMPLIES A DOCKIN© will occur, 


IF (IDOCK t £Q 

read the time 
READ (5,5006) 
WHiTe (6*6070) 
DTMIN «* DTJME 
DTmAX « DTIME 
DCHMIN a DTIME 


0) 00 TO 180 
OF DOCKiNGo 
DTIME 
DTIME 

» DELTAT/10* 

♦ DELTAT/lOe 
- lei^DELTAT 


177 


178 


180 


C 

C 

c 


UCHMAX a DTIME » 0»9*QELTAT 
READ (5,5004) BDMA5S 
WKjTE (6,6574) BDMA S S 
DO 177 M®1*3 
DO 177 n«1*3 

READ (5*5004) BODYDI (M»N) 

continue 

DO 178 m° 1 o 3 

WRiTE (6,6576) MgBODYDl (M.l ) *Mf80 DYDI <m» 21 *M,BOpYDI (M*3) 

CONTINUE . „ 

READ (5,5o 0 2) DTI (1) *DTI (2) ,DTI (3) 

WRjTE (6,6578) dTI(I)»dTI<2) ,dTI(3) 

READ (5*5002) DDOlU) *DD0K2) »DD01(3) 

WHITE (6,6586) DDOlU) ,0001(2) «DD01 (3) 

cont inue 

INPV7 


INPUT 

INPUT 

input 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

input 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

input 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

INPUT 

Input 

INPUT 

INPUT 

INPUT 

INPUT 


C 

C 

C 

c 

c 

c 

c 


INIT 

THIS IS THE ENTRY POINT TO THE INITIALIZATION BLOC*. INIT 

ALL INITIAL CALCULATIONS ARE PERFORMED ONE TIME ONLY FOR EACH CASEINIT 

INIT 

CALCULATE THE TOTAL MASS OF THE CONFIGURATION* INIT 

TOTMAs a BomASS * 01 MASS ♦ BgMAsS ♦ BgMASS ♦ 84MASS INIT 

IGF A «' 0 int7 

ICFB a 0 I wrT 

XCFC «. 0 WIT 
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c 

c 


c 

c 


l CFO a 0 

INITIALIZE THE FLAGS NEEQED TO START THE INTEGRATIONS. 
FLAGl 8 0. 

FLAG2 a 0 9 
FLAG3 » 0. 

FLAG* « 0, 

initialize The QUaTerniOn components. 

A£(g) a 1. 

A£(3) * Q» 

A£ (4) 8 0, 

A£(5) h 0. 

A£D<2) s I. 

A£D(3) « Oft 
A£q<4) sb 0, 

A£Q(5) s Oft 
A.TWO (2) a THETA 1 
ATWOU) • THETA3 
ATW0<4) « THETA4 

ATHREE(2) • UO 

ATHREEO) si' 0 ft 0 
ATHREE (4) a o.O 
ATh 8EE(5) a 0.0 

INITIALIZE the PRINT CHECK FLAG. 

ipntck - l 
Tap a Oc 
TBP o Oft 

INITIALIZE TIME to the TSTART value* 

TIME « TSTART 
XMU a 1.4 o8£*16 
R «* A(J ♦ 3960« 

R 5280 «#R 
Cl * XMU/R#*3 

WS a SORT (cl) 

EEEUtl) a o« 

EEEUtS) a o# 

E£E (Ve3) a 0« 

EeE(2»l) •« 0. 

E£E‘<2.,2) a 0, 

EEE (2*3) a o* 

EEE’Oftl) a 0* 

E£E>(3 B 2) 0, 

££E(3t 3) s Oft 
FFMl) « Oo 
FWa> a o, 

FF(M3) » Oft 
FOJ(l) s 0« 

F01 «2) * Oo 
F0K3) a, Oe 


rogid) * D. 

PQ&<2,) a o a 
F°2'<3) * 0. 

FO (1) s o. 


F0 (4) a- 0 
F^<3) 0 




FU<3) s 0 



Fi2(l) o Oo 
F12;(2) e 0. 
f 1 2 < 3 ) a o, 
FUl) s 0, 
FI (-2) a 0* 


INIT 

INIT 

TNIT 

INI? 

TWIT 

INIT 

IN T T 

INIT 

JNIT 

INIT 

INIT 

INIT 

INTT 

INIT 

INIT 

INlT 

INIT 

INIT 

INIT 

INIT 

IN.iT 

INIT 

INIT 

INIT 

INIT 

INIT 

INIT 

INIT 

INI? 

INI! 

INIT 

mi 

INIT 

INIT 

INIT 

INlT 

INI? 

INIT 

INI? 

TNIT 

INlT 

INlT 

INI? 

INIT 

INlT 

INIT 

INIT 

init 

INIT 

mj 

INlT 

INIT 

INIT 

t»lT 

TWIT 

INIT 

INIT 

INlT 

INIT 

INIT 

INlT 

INIT 
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o oooooooooooo ooooooo ooooooo 


183 

m 


Fi <3> ■ 0* 

TQOGU) ■ 0 
TU0G(2 
TUOG ( 3 
TUOPU 
t«0P<2. 

TWoP<3) 

TQlGdl 
Tu 1 0 ( S ] 

TU1G(3) 

TQIP < i ! 

TuiP(g) 

T«iP(3) 

IF (NUMCMG 
CALL CMO 
UO 183 jBi, NUMCMG 

THATa<J) * THATA(J) » THATaO(J)*DELTaT 
F£E(j) a FEE(J) FEED W> #DELTAT 
CONTINUE 


■ 

a 

a 

• 

• 

a 

a 

a 

■B 

a 

a 


EG. 0) GO TO 184 


A. 

HDOT(l) 

B. 

HDOT (2) 

Cp 

HOOT (3) 

D. 

HIPDOT(I) 

E. 

G300T 

F. 

G400T 


INIT 

INIT 

INfT 

INlT 

IMIT 

IN|T 

jni? 

INIT 

mi 

INlT 

iNIT 

mi 

INtT 

INIT 

jNU 

INIT 

INtT 

INIT 

JNtT 

INlT 

INIT 

INfT 

INlT 

INIT 

INIT 

INI? 

INIT 

INIT 

INIT. 


» 9 W’TV w | 1 ^ 

CALL XDoT INIT 

INlf. 

O 


1?0 CONTINUE 

«* 

* 


THIS IS THE ENTRY POINT TO INTEGRATION BLOCK ONE* INTEG 
THE PURPOSE OF THE ©LOCK IS TO CA{_L A N INTEGRATION SUBROUTINE To INTEG. 
INTEGRATE THE VARIABLES CALCULATED BY SUBROUTINE X D OT. INTEp. 
the arrays USED by the INTEGRATION subroutine MUST BE! calculated INTEG 
EACH TIME BEFORE CALLING THE XNTEGRATiON SUBROUTINE. INTEG 

- _ inTeg 

IF (TIME <N£» TSTART) GO TO 192 INTEG. 
CALL EmCAlC INTEG 
G 3 a EM < 59 1 > *# 0 ( 1 ) ♦ EM<Sp 2 )*WO( 2 ) * EM(S« 3 ) ««o< 3 > INTeg 

* oEM<S? 4 )«» 0 MEGAi * £M( 5 e 5 >»QM£GA 3 * EM ( 5 s 6 > * 0 m£GA 4 INTEG 
G* a £M( 6 »l)»W 0 a) * EM ( 6 <> 2 ) *WO ( 2 ) ♦ EM ( 6 * 3 ) »Wo ( 3 ) INTEG 

* ♦EM( 6 c 4 )» 0 M£GA 1 * EM( 6 * 5 ) <> 0 MEGA 3 * EM ( 6 . 6 ) # 0 mEGA 4 INTeg 
192 CONTINUE fNTEG 

AOnE( 1 ) b TIME INTEG 
AUNE( 2 ) p H(l> INTgp 
A 0 N£.( 3 ) = H< 2 ) INTEG 
AOnE ( 4 ) p H ( 3 ) INTEg 
AONE ( 5 ) 9 H 1 P r IM( 1 ) INTeg 
AONE( 6 ) = G 3 INTEG 


C-IO 



193 


C 

C' 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c- 


A0nE<7> 8 G4 INTEG 
80NEU) a OELTAT INTEG 
80 nE( 2) a HOOT(l) INTEG 
B^nEO) a H00T{2) tn“eg 
BONE (4) « HOOT (3> INTEG 
80nE(5) « HIPDOT(I) INTEG 
BONE ( 6) 3 G3DOT iN r EG 
BONE (7) 3 G400T INTEG 
CAUL F0MS(A0NE 9 80NE»7»FLAGicTJU INTEG 
H(l) a AONE<2> INTEG 
Htg) m AONE (3) INTEG 
H(3) a AON£(4) INTEG 
IF (IOOCK ,gG, 0) GO TO 193 INTEG 
if ((TIME ,UT. OCHMIN) .OH, (TIME oGT 0 DCHMAX) ) GO TO' 193 INTEG 
H ( 1 > a H(l) * DTI(l) INTEG 
H (2) a H(2) ♦ 0TI(2) INTEG 
H ( 3.) a H ( 3 ) * OTI (3) INTEG 
CONTINUE INTEG 
HIPHIMU) a AONE(S) INTEG 
G3 s AONE (6) INTEG 
G4 £3 AONE (7) INTEG 

INTEG 




THIS SEGMENT- S IMPLY CAt.CUt.ATES THE GXmBAL ANGLE- KATES: OF BODIES! 
ONE s THREE, AND. FOUR, THAT IS TO SAY THE SUBSTITUTION NEEDED BY 

integration block two is done at this point. 


TTlDoT a OmEGM 

TT30OT 3 0MEGA3 
TT400T a 0MEGA4 

, 

# - \ 

<» 




this js the entry Point tq integration block two,, 

The purpose of the block is to call an integration subroutine to 

INTEGRATE THE GIMbAL ANGLE RATES OF BODIES ONE, THREE', AND four 
TO PRODUCE THE CORRESPONDING GIMBAL ANGLE POSITIONS. AS BEFORE, 

The arrays used by the integration subroutine must be< calculated 

EACH TIME BEFORE CALLING THE INTEGRATION SUBROUTINE, 


ATWQU) 
BTWOU) 
BTWO (2> 
BTWOO) 
*TW0<4) 


« TIME- „ 
8 DEL t aT 
« TT1DOT 
a TT3D0T 
a TTADoT 


CALL F0mS(aTW0,bTWO* 4,FLAG2,TJ2) 
THgcT A 1 o ATWO (2) 

THET A3 *• ATW0(3) 

THETA4 9 ATWO(^) 


INTEG 

INTEG 

INTEG 

INTEG 

INTEG 

INTEG 

INTEG 

JNTEG 

INTEG 

INTEG 

INTEG 

INTEG 

INTEG 

inTeg 

INTEC 

INTEC 

INTE? 


. ‘ - TNTEf 

a- 


C< 


#< 



oooooooo 


c 

c 

C 

c 

c 


#tt#*««tftt##»« 4 HHt<>####**«*tt«##» 4 »*#*«#**#*«******** 4 #«********** # **+*****< 

QUAT 

This IS the entry point to, the quaternion block. quat 

QUAT 


0 ( 1 * 1 ) 

<m« 2 ) 

0(1*3) 

oiam 
u( 2 * 2 ) 
0(2*3) 
0(2*4) 
0*3*1) 
0(3*2) 
0(3*3) 
0(3*4) 
Q(4*l) 
0(4*2) 
0(4*3) 
0(4*4) 

AED (2) 

AtQ ( 3 ) 

A£0 (4) 

AED (5) 

SET UP 
ATHREE <1> 
BThREE(I) 
6THREE-(2> 
BTHREE(3) 
8THR£E<4> 
BTHREE15) 


a 

p 

m 

a 

a 


Q(li2)*AE<3> 

Q(2»2>*AE(3> 

Q(3,2)OAE(3) 

Q(4*2)#AE(3) 


0,. 

•0*8#WO<1> 

•0.5#WO<2) 

-0.5#WO(3) 

- 0 ( 1 * 2 ) 

0. 

-0(1*4) 

0(1*3) 

•Q(l*3) 

0(1*4) 

0. 

- 0 ( 1 * 2 ) 

*Q( 1 *4) 

•Q ( l*3> 

Q ( 1 * 2 ) 

0 e 

Q(1*1)4AE(H) 

Q(2*1)#AE<2> 

Q(3,1)#A£(2) 

0(4*1) *A£ (2) 

matrices- used 
TIME 
DELTAT 
AED (2) 

AEO (3). 

AED(A) 

AED (5) 

CALL FOMS (ATHREE*BTMRE£*5*FLAG3*TJ3) 

AE (2) m AThREE (2) 

AE(3) m AThREE (3) 

Afi(4) * ATHREE (4) 

At (5) a ATHREE (5) 

CALCULATE THE NORMALIZING FACTOR# 

FN ■ SORT ( AE(2>*#2 ♦ A£(3)»*2 * AE (4,0*2 
AE(2) o AE (2) /FN 
A6(3) o AE(3)/FN 
A£ (4) a A£(4)/FN 
A£ (S) s AE(5 )/fn 

T ( 1 * 1) a A£(H)^2 * Ae( 3)**2 - AE(4)ftftH « 
2,«<AE(3)*AE(4) •• AE (2) #AE (5) ) 
2#*(AE(3)^A£(5> * A£(2J*AE(4>> 
2««*(AE(3) 0 A£(4) ♦ AE<2)*A£(5) > 
Ae( 2)<>42 ■- A£( 3)»«2 ♦ AE( 4 )*ft 2 • 
2,»(AE(4)4AE(5) - A £(2)*AE(3)> 
2 0 *(AE(3>#AE<5) « AE(2)*AE(4)) 
2,<MAE<4)*A£(5) ♦ AE(2)^AE(3) ) 
A£(2>#»2 *■ Ae(3)»*>£ ® AE (4) *m»2 
CALL MUlT <dUM*dUM*0Um 9 Ti8O*TIBOI *T* 2) 

CALL MUlT (HI * TIBO* H*0UM«0UM»DUM* 1 ) 


Q(1*3)*AE(4) 

Q(2*3)«AE(4) 

Q(3,3)#AE(4) 

Q(4*3)«AE(4) 


QUAT 

quat 

QUAT 

quat 

QUaT 

QUAT 

quat 

QUaT 

QUAT 

QUAT 

QUAT 

quat 

quat 

quat 

quat 

qu a t 

QU*4>»AE<5)QUAT 
Q (2*4) *AE(5) QUAT 
Q( 3 . 4 )*AE( 5 )quat 
Q(4,4)*AE(5)qUaT 
QUAT 


b 

c 

a 

p 

a 

st 


♦ 

♦ 

♦ 

* 

8V THE INTEGRATION SUBROUTINE 

QUAT 
QUaT 

quat 

QUAT 
QUAT 
QUAT 
QUAT 
QUAT 
QUAY 
QUAT 
QUAT 
QUAT 
QUA! 
QU A T 
QUAT 
QUAT 
QUAT 
QUAY 
QU A T 
QUAT 
QUAT 
QUA! 
QU A T 
QUAT 
QU A f 
QUAT 
QU A T 

quat 
QUAf 

ft 

P 

ft 

CONYf* 

this is the entry point to contm cont* 


T (1*2) 
T<1*3> 
T (2*1) 
T (2*2) 
T (2*3) 
T(3*D 
T (3*2) 
T (3*3) 


s 

s 

S' 

a 

S7 

B 


♦ AE (S) ft*2 ) 


AE( 5 )*ft 2 


AE(5)ftft2 


♦ AE(5)ftft2 
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c contm 

IF (NUMCMG ,EQ. 0) GO TO 195 CONTM 

CALL HCON CO* T * 

195 CONTINUE CONTv 

FPT ( 1) « 0. COnTm 

FPT(2) » 0, contm 

FPT(3) « 0 , CONTM 

FPT (A) » 0 o CONTV 

pPTlS) « 0. cOnTk 

FATU) O 0, CONJM 

FAT (2) » 0, CONTm 

FAT (3) * 0, CONTm 

FAT (4) » 0, CONTM 

FAT'<5) n 0, CONTM 1 

FAT (6) s 0, CONTm 

FAT (7) * 0. CONTM 

FAT (G) s 0, CONTM 

DO 196 M*l*3 COnTm 

TQOP(M) « Q « CONTM 

TOtP(M) • 0© CONTM 

196 CONTINUE C°NlM 

IF (IPROPF 9 EQ. 0) GO TO 199 CONTM 

IF UATTIF „EQ« 0 ) GO TO 197 COf4TM 

CALL ATT CONTm 

IF UCFA .EQ© 1) GO TO 199 CONTM 

197 CONTINUE CONTM 

CALL PCON COnTm 

199 CONTINUE CONTM 

TMp- .i FATU) + FAT (2) ♦ FPT<2) + FPT(3) ♦ FPT(<M CONTM 

Tap «. Tap © tmp#delTat conTm 

TNP ■ FPT < 1) * FPT (5) CONTM 

TSP a TBP ♦ TNP*OELTAT CONfM 

CQNJM 


a****####*********#**###*#*******####**# **##**#**#*■&*■«■«■*■•&•& #■***««*«»«***« 
# 

* 

#■ 


INVER 

THIS is the entry POINT to THE INVERSION block INVER 

INVER 

CAUL RECALC INVER 

CALL EmCAlC INVEfi 

INVER 

SET UP THE X MATRIX INVER 

00 200 M*l»6 INVER 

DO ,200 N«l©6 INVeF 

X<M»N) 9 - EM(M»N) INVER 

200 CONTINUE . JNVER 

STempi *• B2MASS«SooT*cR2(3)#S2(2> ♦ R2(2)*S2(3)> INVeR 

STEMP2 « 82MASS«SD0T<*( (R2(3)*S2<1) - r 2(1)«S2<3> > # COSTTl • INVER 

9 <„R2(2)*S2<1) ♦ r2U)*S2(2) )*SINiTT1) INVER 

ST 6 MP 3 « B2MASSoSoOT#<(R2<3)aS2(l) - «2U>*S2<3) )*SlNiTTi * INVeR 

* (<-R2<2)*S2(l) ♦ R2(l)«S2f2))>COSTTl> INVER 

STiMPA a SDOT«(S2(2)*(*02 mAsS*R 2<3) ♦ .. (BOMASS*02riAsS/-TOTMAS)* INVER 

* (D0U2) # SINTT1 - 001(3) #COSTTI)) ♦ S2 (3) * (B2MAS$*R2 (2) - JNVEP 

* (80MASS»a2MASS/T0THAS)^(DOi (2)#C0 STTj « DO; <3)*$lNTTl) > ) JNVEP 

STEMP5 * (B2MASS*B3MASS/TOTMAS)#SOOT*< (EL3(3)*S2<1) •* INVER 

* |l3(1)#S2(3) )*s3(2) * (*EL3(2)#s2(1) ♦ EL 3 (1)#S2<2) )*S3<3> ) INVER 

STEMPfe a (B2MASS#BAMASS/T0 TmaS)«S00T* ( (eL4(3)«S2U) - JNVEP 

* ELMl>*52(3))*S4(2) ♦ <-EL4(2)*S2U) ♦ EL4'UM»S2<2> >«S4 (3) ) INVER 

HU) * HU) - STEMPi INVER 





oooooonoo 1 ooooooooo 


203 


^Q‘^ 


H<2> . H(Z) * STEMPZ 

xnveb 

H(3> « h(3) - STEMP3 

INVER 

HlPRlM(l) « H1PRIMU) - STEMP* 

|NV£fi 

03 * G3 + STemP5 

INVfF 

04 ■ Q4 ♦ STEMPG 

INVER 

IF (IPNDLM *EQ. 0) 00 TO ZQ'd 

INVEP 

DO 801 M*i*3 

invef 

V(M> «t H<M) • FFF(M) 

INVER 

continue 

INVER 

*<1.7) a V(U 

inve r 

X(2?7) s V (2) 

JNVER 

X(3*7) a V (3) 

INVER 

X(4*7) a HlPRIM(l) 

INVER 

X(5»7) ■ G3 

INVER 

X<6*7) » 34 

INVER 

CALL SYEQNSW*6*6,7|FlAG) 

INVEfl 

W0{1) n X(i,7) 

INVER 

WO (2) B X<2*7) 

INVER 

W0(3) « X<3*7) 

INVER 

OMEGA 1 a X (4*7) 

INVER 

0MEGA3 c X ( 5 9 7 ) 

INVER 

0MEGA4 a X(6»7) 

INVER 

GO TO 2Q4 

INVER 

conT inUe 

inveR 

DO 203 M«l*3 

INVER 

V (M) « H(M) • FFF(M) 

INVER 

continue 

INVER 

Mlt5) a Vq) 

INVER 

X (2*5) 9 V (2) 

INVER 

X (3*5) « V (3) 

INVER 

X(4»5) a HlPRlMU) 

inver 

CALL SYEQNS(X»4?G*7?FLAG) 

INVER 

WQU) a X < 1 *5) 

INVER 

W0(2) o X (2?S) 

INVER 

WO (3) s X(3*5) 

INVER 

0MSGA1 « X (4*5) 

INVER 

0MEGA3 * 0 0 

INVER 

0MEGA4 9 0, 

INVER 

continue 

INVER 


INVER 
a 


##»<» e«if96«r«c«#flS«#»#996o« «•"»•» -a- «&«&«#aa-#tt«a#»eaeeeaa»tt4»&a«»«««4d'a 


UPDATE TIME 

TSm£ w time » DELTAT 
call XDoT 

« 

# 

THIS IS THE ENTRY POINT To THE OUTPUT BLOCK* 

IF ( XPNTCK #NE# IPRINT) GO TO 2l5 
C SKIP To A NEW PAGE AND P^INT a LINE Of aST£RickS s 
W«ITE(6 9 6502) 


OUTPt 

OUTPi 

OUTpL 

OUTPL 

OUTpl 

OUTPI. 
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WHITE<6»6504> TIME 
If (IOOCK »EQ. 0) 00 TO 208 

If < ITIME.LT.DTMIN) .OR* <TIME e GT,DTMAX) ) ©0 TO 20® 
WHjTE(6 9 6580) 

IDOCK a 0 
20 ® continue 

WKxTe(6 9 055O) 

WRITE (6*6510) HU) *H<2) *H(3) 

" WRSTE(6 9 65j4) hDOTU) «HD0T(2) »HDOTU) 

#*XTE(6,6Sig) HSU)«HX(2)*HX(3) 

00 20? ml .3 

WHXTE<®9&®38) M3TiBO(m?U *M 9 TI8o(M 92) ®MtTl80(M«3) 
207 CONTINUE 

WRITE(6*6536> THETQ»ToTMAS 

j b 0 

WNiTe<6 # 6552> J 

WRITE (696008) W0<1> ?Wo(2) » WO (3) 

J « 0 

WRiTE (6*6526) j«R0<l> *JeR0(2) * JsR0(3> 

W«XTe (6,6554) 

J 3’ 1 

WRxTE (6*6552) j. 

WRITE 10*65q6) j,W 1U) oj9Wl<2> tJ»Wl(3) 

WRITE (6,6526) J*R)(l) 9 J 9 RK 2 ) »J*Ri(3) 

WRITE (6*6528) J*RlDOT (1) 9 J*R1D0T (2) »J,R1D0T<3) 

WRITE(6,6o42) THETAWOMEGAi 

WRjTg<6,6554) 

If (IB2F *EQ* 0 ) GO To 209 

^ 25' 2 

WR jTg (6»655H) J 
WRlTE(6 9 65§6) SpSOOT 

WRITE (6*65j? 2) J*Et2U) »U9EL2(2>9J9E1.2(3) 
WRnE(®9«>5 2 4) j,Eu20OTa)»J.EL2DOT(2) 9 J9EL2D0T(3> 
WR|Te( 6«6526> J« R 2(l) 9sJt R 2(2) 9J#«2(3) 

WRITE (6*6528) J*R2D0T (I) * J*R2D0T(2> » J,R2D0T(3> 

209' CONTINUE 

W r iTe (6*6556) 

If (IPNOLM oEQ* 0) 00 TO 211 
J .a 3 

WRITE (0*0852) j 

W R XTE(6 9 6506) OpW-3U> 9J9«3(2) »J?W3(3> 

WRITE ( 696 S 16 ) JfM3PRlM(l) 9 J*H3PRIM (2) ,J 9 H3PRiM<3> 
WRITE (0*0522) J^Eu3 ( 1 ) » J»EU3 (2) »J'EL3(3) 
WRlTE(6*65g6) JfEL300T(I) 9J*EU3D0T(2) ,J*EL300T (3) 
WRITE (690526) J9R3U>9U*R3(2) »J»R3(3> 

WRITE ( 6 *&Sg 8 ) 4*R300T(I> 9J»R3D0T(2> *J,R3D0T(3) 
^ R I?E (6*6558) J*THETA3tJ*0MEQA3 
WRITE ( 69656 O) J»G3tU903D0T 
WRITE (6*6556) 
j. «- 4 

WRITE (6* 6552) J 

WRlTE(6*65o6) JtW4'(l) t J«W4(2> *J,?W4(3) 

#&*TE (6*6516) ^H0PRIMC1) »J*H4PRIM(2) ,J*H4PRIM(3) 
WRITE (6*6522) l) *J*EL4<2) *U9EU4<3) 

WRXTE(6*05g4) J*Et4D0TU) 9 J*EL4D0T(2> *J*EU400T(3) 
WR lTE(0*65g6) J*R4<1) » J9«4(2) 9J9 R 4(i) 

WRITE (6*6528) J*R400T(1) 9j*R4D0T<2) »J,R4D0T<3> 
WRITE <6*0558) J 9 THETA 4 , J*0MEGA4 
WftjTE-(6*6560) J*G4»J9G4D0T 

211 continue 

If UPROPF sEOe 0) 60 TO 212 
WRITE('0’9®5®® ) TAP 


OUTPU 

OUTPt 

OUTPU 

oum; 

OUTPt 

OUTPt 

gUTpU 

OUTPU 

OUTPU 

OUTpU 

OUTPU 

OUTPU 

OUTpU 

OUTPU 

OUTPU 

OUTPU 

OUfPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTpU 

OUTPU 

OUTPU 

fiUTPU 

OUTPU 

OUTPU 

OUTpU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 

OUTPU 
OUTPU 
OUTpU 
OUTPU 
OUTPU 
OUTpU 
OUTPU 
OUTPU 
OUTpU 
OUTPU 
OUTPU 
OUTpU 
OUTPU 
OUTPU 
OUTpU 
OUTPU 
OUTPU 
OUTPU 
OUTpU 
OUTPU 
OUT PL 
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WHITE <6* 6590 TBP OUTPI 

212 CONTINUE OUTPL 

IF (NUMCMG ,EQ, 0) 60 TO 214 OUTpL 

00 213 J*»l iNOMCMG OOTPL 

WHITE (6*6028) J»THATA( J) i JiTHATAD(J) OUTPl 

IF (IDOFU) »NE* 2) 60 TO 213 OUTPl 

WHiT£(6,6032) J*FeE(J) *JiFEED(J) OUTpl 

213 CONTINUE. OUTPL 

2 ia continue, outpi 

ipnTck « o oV T P L 

215 IPnTCK a IPNTCK ♦ 1 OUTPL 

. OUTPI, 


IF UOOCK ,NE. 1) 60 TO 220 

1F<(TIME»UT < 0CHMIN).0H,(IIME # 6T,,DCHMAX)> 60 TO 220 
DO 218 M»l*3 
DO 216 n° 1 * 3 

BOOXOI(M*N) a 0ODYDI (M*N) 

218 CONTINUE 

bomAss ° sdmass 

DOU1) b OOOHl) 

001(2) a DD0K2) 

001 (3) 8 DD01 <3) ■ ^ 

TOTNAS a 80MASS ♦ 81MASS ♦ B2MA$S * B3MASS ♦ BAmASS 
60 TO 190 

220 IF (Time ogTo.tstop* so to 10 
60 TO 190 ' 

* 




THIS SECTION CONTAINS ALL OF THE INPUT AnD OUTPUT FORMATS. I/O 

1/0 

5.000 FORMAT (lX*l2) I/O 

5002 FORMaT(iX»3(FHo5,2X) > I/O 

5006 FORMAT (1X*EI1»4> . I/O 

500* F0RMAT(U»FU.5> I/O 

5008 FORMATaXcEn«A*2X9Ell 0 A> f/O 

6000 FORMAT (iHl* JX* 16H THERE ARE (IS) *I2*22H DATA DECK(S) PRESENT.) I/O 
6002 FORMAT (IHU IX, I4HTSTART s *E13*6, 23X* UHTSTOP s *El3 o 6,I/0 

* 23 x *14H0gUAT a ,E13*6) I/O 

6006 FORMAT < 1X9 HHAtTlTODg « ®E13.6) , I/O 

6006 FORMAT < IX *6hTI 80I (9ll*7H*I) = 9FUo5>25x,6HTlB0n*Il.TH*2) a , I/O 

* Fll# 5* 25)( 0 6hTIBOI (pI1*7h*3) - t/0 

600? FORMAT (IX, l4 H W0U> a 9El3e6*23x»l4HW0<2) ■ *El3o 6 923X, j/O 

* 14HWQ (3) a *E13o6) y/O 

6010 FQRMAT(lXnH8*Xl«l2HMASS a *£13,6) I/O 

6012 FORMAT (IXsThSODYOI (»|1«6h»1) o ,E13.6 9 23X*7hB 0DYOI ( * II 96H,2) a * I/o 

«Ei3,6923X*7H80DY0l (*H*6H,3) e *El3e6) I/O 

6014 FORMAf UX*HHNUMCM6 a 9 12) I/O 

6016 format < ix«nHCM6 number *ii92iH is a reaction wheel.) i/o 

60i8 FORMAT uA*HHCM 6 N U MBE& *U*26H HAS OnE DEGREE OF FREEDOM) I/O 

6020 FORMAT (lX,nHCM6 NUMBER * i 1 * 27H HAS TtfO DEGREES OF FREEDOM) I/O 

6022 FORMAT UX»35 HTHE ANGULAR momentum of CMG number *Ii, 3H a ,£13.6) "I/O 
6024 FORMAT ( lX 9 gHAOCJ (eXl»lH»9li*6H*l) « *Fn»5i25X,5HA0CU(*Il*lH99ll, I/o 

* 6H,2) a «Fn 9 5?25X,5HA0CJ(*n»lH*9ll,6H*3) = ?F11.5) I/O 
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6026 F 0 RMAT< 1 X« 4 HAII < ♦ 1 1 » 1 H» * 1 1 ♦ ?H* 1 > 31 »£ 13 * 6 * 23 X, 4 HAI I ( » II » 1 H» ♦ 1 1 • j/O 

* 7 H* 2 > * ,£l 3 . 6 , 23 X» 4 HAlI(,Il*lH»*n, 7 H» 3 ) * *El 3 . 6 ) I/O 

6028 FORMAT( 1 X* 6 hTHATA(,U, 7 h> ■ ,Ei 3 , 6 , 23 X, 7 hTHAT a D( t I 1 * 6 H) o , I/O 

* £ 13 . 6 ) j /9 

6030 F 0 RMAT(lX* 4 HAl 0 (*n*lH*» Jl* 7 H*D * *Fi 3 . 6 * 23 X, 4 HAlO ( * II * 1 H» * II * I/O 

* 7 M , 2 > e t £l 3 . 6 ,H 3 x*AHAlO(,ll*lHt *U, 7 h» 3 > * ,£l 3 . 6 ) I/0 

6032 FQRMAT( 1 X» 4 hFEE(»H* 9 H) * ,El 3 . 6 , 23 X, 5 H FEE 0 ( «il » 8 h> * « I/O 

* £l 3 e 6 ) I/O 

6040 F 0 RMAmX 97 HB 00 YUUIlt 6 H*l) a »E 13 * 6 , 23 X» 7 HB 0 DV 1 I ( • II * 6 H ,21 a * I/O 

* £ 13 » 6 , 23 x, 7 hBqQYU (»H» 6 h* 3 ) a »E 13 . 6 ) I/O 

6042 FORMAT (lX« 14 HTh£ 7 A& * ,E 13 , 6 » 23 X, 14 H 0 MEGA 1 a ,El 3 , 6 > I/O 

6044 FORMAT ( 1 X» 14 H 00 I<U a ,£ 13 . 6 * 23 X, 14 H 001 ( 2 ) a *El 3 , 6 , j/O 

* 23 X, 14 H 0 Q 1 (31 = .E 13 . 6 ) I/O 

6048 FORMAT ( 1 X 9 14 H 013 ( 1 ) a ,E 13 . 6 * 23 X, 14 H 013 ( 2 ) a »El 3 , 6 t J/O 

* 23 X» 14 HD 13 ( 3 > = , E 13 . 6 ) I/O 

6 QS 0 F 0 RMAT( 1 X* 14 h 014 (i) 3 ,E 13 . 6 , 23 x, 14 HD 14 < 2 > a *El 3 , 6 , j/O 

* 23 X* 14 H 0 J 4 ( 3 ) s ,E 13 « 6 ) J/O 

6052 FORMAKIX 9 JMStH»l 2 H(l) = »El 3 . 6 » 23 XtlHS*Il»l 2 H( 2 ) a , 1/0 

*Ei 3 i 6 g 23 X 9 IMS', I l,l 2 H ( 3 ) a ,El 3 # 6 ) j/o 

6058 FORMAT (lX 9 i 4 HPEND 3 l. a ,£ 13 . 6 ) I/O 

6060 FORMAT ( IX? HWTNETA 3 a ,E 13 . 6 ) j/O 

6062 FORMAT ( 1 X 914 HOMESA 3 3 9 E 13 . 6 ) I/O 

6064 FORMAT (lX ? ^HPEN£> 4 L c 9 £ 13 * 6 > j/O 

6066 FORMAT < JX, X^HTHETAA a ,£ 13 . 6 , 23 X, 14 H 0 MEQA 4 « ,El 3 . 6 > I/O 

6068 - FORMAT ( 1 X,i 4 hIDOCK =,I 2 ) I/O 

6070 FORMAT ( 1 X, 14 HDTIM£ a ,E 13 . 6 ) I/O 

6072 FORMAT (iXeHHlPROPF * ,I 2 )‘ I/O 

6074 F 0 RMAT( 1 X 94 hAOJ( 9 I 2 » 8 h 1 a ,E 13 , 6 , 23 X, 7 hCGAINQ(,I 2 , 5 h> a , I/O 


* 613,6) 

6076 F0RMAT<1X,4HA1J(*I1»9H) a ,E13*6,23X,7HCGAIN1 < , U ,6H) 

* eiM> « 

6078 FORMAT ( 1 X*X 4 HI 8 r AVF a , 12 ) 



6080 FORMAT (lX,14HSP = ,E13,6> I/O 
6082 FORMAT (1H1, IX, 9HXPNDLM * »I2,/> I/O 
6b0b^F0RMAT(iHl,lX,46H The FOLLOWING INPUT CORRESPONDS To DATA DECK ,121/0 

6502 FORMAT ( 1 Hi 9 IX , l27H** # ** # **** # * # ** #### ** ## **** # * # **** # ***** # *******f /O 


65Q4 FORMAT(1X«i4hTIME 
6506 FORMAT (lX,iHW, I 1, |2H( 1) 
*£l3o6,23X* 1HW, I 1» 12H (3) 
6510 FORMAT ( 1 X 9 14HH(D 

* 23 X 9 14HH (3) 

6512 FORMAT ( 1X9 14HHIU) 

• 23Xe 14HHI (3) 

6514 FORMAT (iX,i^HHDOTa) 


,F 1 1 . 5 , /) 

»El3.6t23X,lHW,n»l2H<(2) 

» »E13,6> 

,E13.6,23x, 14HH(2) • ,El3 e 6, 

♦E13,6) 

,E13*6,23X,14HMI (2) * ,El3,6t 

,E 13 . 6 ) 

9E13^6,23X,14HHD0T<2) ■ »El3,6, 


* 23X9 14HHQQT (3) a 9E13.6) j/O 

6516 FORMAT (lX,lHH,Ht I2HPRIM ( 1 ) a ,El3.6»23x*lHH*Il»l2HPRlM<2) = , 1/0 

♦Ei346,23X9iHH,il,l2HPRlM(3) a ,£13. 6 ) j/O 

6522 FORMAT < iXcgHEL, II, 11H ( 1 ) a »£13,6»23X»2HEL* I L , 1 1H(2) a ,1/0 

♦£13.6,23X9gHELe I 1 , 11H (3) a ,El3.6> j/O 

6524 FORMAT aX, 2 HEL,n,UHOOT(l) »El3.6,23X,2HEL, 1 1 ♦ 1 IHDOT (2) a , 1/0 
*6l3,6923X9gHEL,lUUHD0T(3) » *E13.6> j/O 

•6526 F0RMAT(lX,lHR9il9l2H{l) a ,El3.6,23XtlHR, Ii*l2H ( (2) a, I/O 

OEi3«6,23X, IMP, I1,12H(3) » #El3.6) j/O 

6528 FORMAT(1X91HR,I1»12HOOT(1) « ,El3.6,23X»lHR,Il, 12HD0T (2> a ,1/0 

#6l3,6,23X9lHR,n9l2HOoT(3) ■ ,El3,6> I/O 

6535 FORMAT ( lX, J4H012 ( 1 > a 9 E13,6, 23X, 14H012(2) - ,El3.6, j/o 


. * 23X»14HD12(3) « ,El3,6) I/O 
6536 FORMAT ( IX, 14HTHET© ■ fFn^aSXfUHTOTMAS « ,El3.6,/) j/o 
6538 FORMATaX,5HTigO(,n,8H,l) a ,F11 »5,25X,5 hTIB 0H » II »8H,2) a , I/O 



ononn 




»C13»6»83K # HhSdoT a ,El3#6) 

c ♦E13#6 9 23X#5HOME0A 5 H»8H b 

o »Ei 3 * 6 »a 3 X»|H 0 #lJpl 2 HD 0 T 


♦FU.S»2gX.5HTlB0(fIJ»8H»3) « «FH*5) 

6544 F0RMATUX»14HIPfilNT * #12) 

.6546 FURMAT<IX»HMI92F * *13) t 

6549 F0RMAT( lX»|4HS « »Sl3.5f23x, l^MSDOY 

6550 FORMAT U*»19HGEN5RAL INFORMATION?/) 

6552 FORMAT UXtgHBOOY ?U»I2H INFORMATION,/) 

655a FORMAT (/) 

6556 FORMAT uX,iahS 
■6559 FORMAT( lXiSHTHETA,IIt8H 

* 

6560 fo«mat< iXoiHGiiman 

• £13,6) 

6568 F0RMAT( IX»j4hIATTJF 
6564 FORMAT U*»14HCA(l) 

, * 2.JX, IARCA (3) 

6666 FORMAT < UiIAhAAOI 
6560 FORMAT UX,I4HAA02 
6570 FORMAT (1XH4HN0A IN 
6572 FORMAT <1XpSHQAIN<, l i»SH) 

6574 FORMAT UX,^4hBDMASS 
6576 FORMAT OX0 7HBOOYOI (*Ilo6Hol) 

«613,6«2:jX,7hBo0yDi (»Jh&H»3) 

6578 FORMAT (iX»i4HDTl (J) a ,El3o6o23X f HHOTl (2) 

a * 23Xel4H0TJ<3) a eE13,6) 

658o ’FORMAT <1X»20 HOoCKiNG has OCCURRED) 

6582 FORMATaX, J4HCP1 ■ ,El3o6) 

6|8* FORMAT (iX*j4HCf?2 a «ES3»6-) 

6586 FORMAT < IX, 14HDD0UD * 9EJ3 o 6?23x t 14HDD01{2) 

• 2iX, JAHOOOi (3) « «E13*6> 

6588 FORMAT< iX?S4HTHE- TOTAL PROPULSION IMPULSE ON THE 
« pE 43 o 5 ) 

6590 FORMaT<iX ? 48hThE TOTAL PROPULSION IMPULSE ON ?Hg 

• El 3 o 6 ) 


S 

5 
a 
» 

6 


a ,£X3«6, 


m 

s 


♦ ID 

,EI3»6»23X, 14HCAI2) 

,E13o6) 

,EI 3 9 6 , 23 X 9 14 HAGAJNI 

• EI3e6«23X' t 14HA6AXNS 

, 12 ) 

» »E13«6) 

*E13o6) 

c 9EI3*6 c23X»7HB0DYDI (,X1«6H,2) 
a ,El3a6) 


*El3«6) 

9 E13c6) 


a • 


a ,El 3 o 6 * 


a 9 £l 3 « 6 , 


\d 

v ;o 

Vo 

VO 

I/O 

Vo 

I/O 
I/O 
I/O 
I/O 
♦ I/O' 
I/O 
I/O 
I/O 
I/O 
I/O 
I/O 
I/O 
I/O 
I/O 
I/O 

i/o 

I/O 

i/o 

I/O 

I/O 

I/O 

I/O 


I/O 

transverse axis sx/o 

e . . „ x/o 

SPIN! AXIS a , I/O 

I/O 

I/O 

&■ 

8 ' 


END 
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SUBROUTINE ATT 


0 

« 


common 

A(3> 

t 

a£(5> 

* 

AED(s) 

t COMMC 

& • 

AFOUR(g) 

9 

AX X ( 69393 ) 

t 


COMMC 

« 

AXO (6?3ft3) 

9 

AJltf) 

» 

ALT 

9 COMMC 

« 

AoC^M&jSjS) 

9 

AOJ (3) 

♦ 

AONE( 7 ) 

9 COMMC 

# 

ATCPT2<3»3) 

9 

ATHREE{5) 

9 

ATWO(^) 

9 COMMC 

0 

Al (3e3> 

9 

Al J (2) 



COMMC 

COMMON 

BDMASS 

9 

8FOUR<2> 

* 

BMQM 

9 COMMC 

0 

B00Y0I(3,3) 

9 

BODYOI (3» 3) 

9 

BODY! I <3? 3) 

9 COMMC 

« 

SOMASS 

9 

BONE (7) 

9 

BThReE (5) 

9 COMMC 

0 

0TWO (A) 

9 

BIMASS 

9 

B2MASS 

0 COMMC 

« 

83MASS 

9 

B4mASS 



COMMC 

COMMON 

CM3) 

9 

C8<3) 

9 

C0A jmO (3) 

9 COMMC 

0 

CGAJNK2) . 

9 




COMMC 

0 

COSFgJ 

9 

costTj 

9 

COSTTO 

9 COMMC 

# 

COSTT1 

9 

C0STT3 

9 

COSTTA 

9 COMMC 

0 

C02? 

9 

CPI 

9 

CP2 

9 COMMC 

0 

CST 

9 

Cl 



COMMC 

COMMON' 

OB (3) 

9 

DOOiO) 

9 


COMMC 

# 

deltat 

9 

001(3) 

9 

OOiOOT (3> 

9 COMMC 

9 

OTIO) 

9 




COMMC 

0 

•OTIME 

9 

012 (3) 

9 

013(3) 

9 COMMC 

0 

D13D0 7 (3) 

9 

0I3YCS 

9 

013YSN 

♦- COMMC 

« 

D13ZCS 

9 

013ZSN 

9 

014(3) 

9 COMMC 

0 

0&4DQT(3) 

9 

oi^yCs 

1 

D10Y$N 

* COMMC 

# 

0|4ZC S 

9 

D142 s N 



5 OMMC 

COMMON 

CCE(3»3> 

9 

EEJO 93 ) 

9 

EUe<3> 

9 COMMC 

« 

EU200T(3) 

9 

EU2YCs 

9 

EU2YSN 

9 COMMC 

0 

EL2ZC S 

9 

EL2Z S N 

ft 

EL3<3> 

9 COMMC 

0 

EU3D0TO) 

9 

EU3YCS 

9 

EL3VSN 

9 COMMC 

0 

EL3ZCS 

9 

EL3ZSN 

9 

EUM3) 

9 COMMC 

0 

ELADQ|{3) 

9 

el^yCs 

9 

EU^YSN 

ft COMMC 

« 

EL4ZC S - 

9 

EL4Z § N 

9 

emi6»6) 

COMMC 

‘COMMON 

FAT (8) 

ft 




COMMC 

0 

FEE (6) 

9 

FEED (6) 

9 

FFF (3) 

9 COMMC 

0 

FFJ (3) 

9 

FLAGi 

9 

FUAG2 

9 COMMC 

0 

FLAG3 

9 

FWG4 

' 9 

F-Ni 

9 COMMC 

#- 

FO<3) 

9 

F01 (3) 

9 

F02(3) 

ft COMMC 

0 

F03 (3) 

9 , 

FI (3) 

ft 

Fli (3) 

9 COMMC 

0 - 

FPT(g-) 

9 




COMMC 

0 

FX2 <3> 

9 

F13(3) 


• 

COMMC 

COMMON 

GAXNtlO) 

9 

G3 

9 


COMMC 


G3D0Y 

9 

Qfy 

9 

G400T 

COMMC 

COMMON 

H(3) 

9 

HCMG (3) 

ft 

HOOT (3) 

ft COMMC 

0 

HX<3) 

9 

HOOP 

9 


9 COMMC 

0 

HI <3) 

9 

HXPOOt (3) 

9 

H1PRXM(3> 

ft COMMC 

0 

H3P*IM(3) 

9 

HQP^XM (3) 



COMMC 

COMMON 

3B2F 

9 

I-CFA 

9 

ICFB 

ft COMMC 

0 

JCFC- 

9 

icfd 

ft 

i dock 

9 COMMC 

0 ' 

XDOF(^) 

9 




COMMC 

#• 

I0RW-- 

9 

’■j-pndlm 

9 

■ XPNTCK 

9 COMMC 

0- 

XPRSNT 

9 

IPROPF 



COMMC 

COMMON 

ncase 

9 

nCheCk 

9 

NDECK 

9 COMMC 

0 

ngA|n 

9 

NUMCMG 

• 


COMMC 

COMMON 

omegai 

9 

0 MEGA 3 

9 . 

0MEGA4 

COMMC 

COMMON 

PEN03L 

9 

PEND4U 



COMMC 

COMMON- 

G(4g4> 


- 



C0MMI 
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COMMON 

R ♦ 

RO<3> ' 

Rl<3) 

» COMMC 

* 

R100TO) » 

R1YC5 ♦ 

R1YSN 

* COMMC 

« 

R1ZCS ♦ 

RlZSN « 

R2;(3) 

» COMMC 

♦ 

R2D0T(3) , * 

R2YCS # 

R2 YSn 

* COMMC 

* 

R2ZCS * 

R2ZSN ♦ 

R3 (3) 

* COMMC 

• 

R3DoT(3) * 

R3YCS ♦ 

R3YSN 

* COMMC 

# 

R3ZCS * 

R3ZSN t 

RM3) 

* COMMC 

• 

R4D0T<3) * 

R4YCS , 

R4-YSN 

* COMMC 

* 

R4ZCS f 

R4ZSN 


COMMC 

COMMON- 

$ * 

SOOT * 

SINFEU 

* COMMC 

• 

SINTTJ t 

SINTTO » 

SINTT1 

* COMMC 

* 

SinTTS * 

$intt 3 , 

SINTT4 

♦ COMMC 

• 

SP f 

SUM1 » 

SUM2 

* COMMC 

• 

SUM3 t 

32(3) » 

$3(3) 

* COMMC 

4 

$4(3) 



COMMC 

COMMON 

T (3*3) * 

TC(3*3) t 

TEMPI (3) 

* COMMC 

• 

TCMpao) * 



COMMC 

• 

TEMP3<3) * 

TEMP4(3) , 

TEMPS<3*3) 

* COMMC 

♦ 

TEMp6<3f3) t 

TEMPT (3*3) * 

T EMP8 (3*3) 

* COMMC 

* 

TEMP9(3»3) * 

T£mP 10(3*3> t 

tEmpik 3*3) 

* COMMC 

» 

T£MP12(3»3) » 

TEMP13(3*3) * 

TEMP14(3»3) 

♦ COMMC 

• 

TEMPl5(3t3) » 

TERM1 (3) , 

TERM2 (3) 

* COMMC 

♦ 

* 

TFRlCT « 

THETA! t 

THAT A (6) » 

THETA3 , 

THATAD(6) 

THETA4 

* COMMC 
9 COMMC 

* 

TheTo * 

T !BO (3,3) ■ 9 

TlOOI (3*3) 

» COMMC 

* 

TIME » 

TJ 9 

TUI ( 10) 

9 COMMC 

* 

TJ2(10) * 

TJ3U0) 9 

TJ^(IO) 

9 COMMC 

♦ 

tmoToR * 



COMMC 

• 

T0EF(3) * 

TOTMAS * 

TO-l 

* COMMC 

• 

TQOG(3> 9 

TQOPO) * 

TQ1G(3) 

* COMMC 

• 

TQ1F(3) 9 

tsta«t , 

TSTOP 

* COMMC 

* 

TTIOOT * 

TT300T t 

TT400T 

* COMMC 

« 

TlEF (3) » 

T13 * 

T14 

COMMC 

COMMON 

V <3> 



COMMC 

common 

woo) * 

ws * 

Wl < 3) 

* COMMC 

« 

W3 (3) 9 

W4<3) 


COMMC 

COMMON 

X<6*?> * 

xc * 

XCDOT 

* COMMC 

• 

KMU 



COMMC 


C CQMM< 

C #######**#0*»#4fl'#*#**o»*<»*#»*#«>##****#»*e**-»«'»#*«******»#«M < *** o * < *** <i '<MH 

C * 

C * 

c * 


C W 

ICFD * 0 ATT 

IF UCPA *£<3, l) ©°-T0 n ATT 

IF (A$S(WOtg>) 0 GT* 0*0002) GO TO 60 AJT 

If (A$S(W0<3)> «GT* 0,0002) qq TO 60 Aft 

DO 10 Mol *3 ATT 

CB(M) « TibO(1,M)#CA(1) ♦ TjbO (2?M) *Ca < 2> ♦ TlBO (3, M) «CA (3) ATT 

10 CONTINUE AtT 

IF <C8(D oLT* 0»W4) 00 TO 11 ATT 

ICP4 m 0 ATT 

ICF8 « 0 Atf 

*CF€- * 0 ATT 

GO TO $0 ATT 

11 continue ATT- 

K?A o 1 ATT 

IF (ICFB eEQo 1) GO TO 3Q ATT 

Tma Time • > aTt 

ZTcL 9 09 Aft 
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DO 13 Mvlr 3 AfT 

DO 13 Mel *3 ATT 

TC(M»N) a TlBO<M»N) ATT 

13 Continue Aft 

CN 9 C0(3)O®2 ♦ C0(2)#<»2 aTT 

CN • S0PT(CN) AtT 

CA 2 m C 6 ( 2) /CN ATT 

CA3 o C«<3)/CN *TT 

AL * OoS®ACOS<C©(U ) AfT 

Ak a BODY 1 1 < 1 g 1 )#QMEGAi*SIN < At) / (5.5 4 DELTAT) ATT 

ICFB e 1 ATT 

90 CONTXNUE ATT 

tmachk a Tma + §*o ait 

IP (TIME eGTe TMACHK) GO TO 40 ATT 

ICFD 0 l ATT 

WO TO GO ATT 

40 CONTINUE ATT 

If (KFC ,EG e 1 ) GO TO 50 Aff 

ZTC « ®CA3»<TC<l»2)*TlB0(l9l)< > TC(2*2)»TlB0(2»l)*TC(3,2)«TiB0(3*I))ATT 
* <>CA2«(TCa»3)^Tl80UU)*TC(2*3)*TlBO(2*i)+TC{3»3)«Tieo(3nnAtf 

If (ZTC eGTo ZTCL) GO TO 71 ATT 

ZTCt, a ZTC ATT 

GO TO &0 AfT 

continue ATT 

TM0 a TIME ATT 

TMC a TmS • TMA - 0,0 ATT 

TMC a T mb * TMC ATT' 

TMB = TMC ❖ 5 e 0 AfT 

SCFC a 1 Afr 

GO To 60 ATT 

r CONTINUE Aft 

If (TIME- «GTo TMB) GO TO 80 AfT 


GO TO &0 
71 COnTjnUe 

TMg a-- TIME 

TMC a TMB « TMA - 6*0 
TMC a TmB * TMC 
TMB a TMC ❖ 5 e 0 
SCFC a l 
GO To 60 
50 CONTINUE 

If (TIME- «GTo TMB) GO TO 80 
If (TIME oLT* TMC) GO TO 6 o 
ICFD a l 
GO TO 60 
BO CONTINUE 
jCpA B. 0 
ICF© s 0 
ICPC 3 0 

60 CONTINUE 

If (ICFD 8 EQ, 0) GO To *0 
TGOf(g) m AK«CA2 
T«OP(3) e AK»CA3 
FAT(l) e- 2,eAB§(TQ0P(2)/A0J.(2)) 
FAT (g) a 2 .oaBS(TQ0P(3)/A0J(3) ) 
90 continue 
6,5 continue 
return 


GO To 90 


ATT 

AfT. 


. ... . « I I 

JB 
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SUBROUTINE CMG 
C * 

C *• 


C 

c 


« 


<M9 ««» pppP P 4 Ott 4> 4 # i> * O 4 O «■ 0 0 « O « 00 O # «■ ### O P <H» # # P #0 «HHH» «*.# fcSOft# <J ##«*«** *#<MK 


COMMON 

A (3> 

9 

AE<5) 

9 

AED ( 5) 

9 

• 

ArOUR( 8 ) 

9 

AH ( 6 *3*3) 

0 



* 

AXO (693*3) 

9 

AJ1 (3) 

9 

AL/ 

f 

« 

AQCJ (6*3*3) 

9 

AOJ (3) 

t 

AONE (7) 

* 

0 

ATCPT2(3p3> 

9 

ATHREE(S) 

9 

ATWO(*> 

* 

p 

Al (3*3) 

* 

AXJ<2> 




COMMON 

9DMASS _ 

9 

8 F 0 UR< 2 ) 

* 

bmom 

* 

P 

BODYDl (3*3) 

9 

SOOY0X(3 9 3) 

9 

800Y11 (3* 3) 

* 

p 

BOMASS 

9 

BONE (7) 

9 

bThR£E(5) 

• 

p 

8TW0(4) 

9 

BIMASS 

9 

B2MASS 

9 

p 

83MASS 

9 

B^mASS 




'common 

CA(3) 

9 

CB (3) 

* 

CGAIN0(3) 

* 

p 

CGAXNl (2) 

9 





* 

COSFEJ 

9 

COSTTU 

9 

costto 

* 


C0STT1 

9 

C0STT3 

* 

C05T74 

9 

« 

C 02 T 

0 . 

CPI 

9 

CP2 

9 

p 

CST 

9 

Cl 




COMMON 

09(3) 

9 

ODOi (3) 

0 



* 

oeltat 

* 

001(3) 

9 

D0100 t (3) 

* 

# 

DTI (3> 

9 





9 

OTIME' 

9 

012(3) 

9 

013.(3) 

9 

P , 

D13D0T (3) 

9 

013VCS 

9 

013YSN 

9 

9 

013ZCS 

9 

013ZSN 

* 

014(3) 

9 

P- 

Dl^DOT (3) . 

9 

omCs 

0 

oi^ysn 

9 


0&6ZCS 

0 

DIAZSn 




'common 

EEE (3*3) 

9 

£EJ(3*3> 

9 

EU2<3> 

9 

9 

EU2D0TO) 

9 

EL 2 YCS 

9 

EL 2 YSN 

9 

p 

EL2ZCS 

C 

EU2ZSn 

9 

EU3(3) 

9 

9 • 

Et,300T(3) 

9 

EL3YCS- 

0 

EU3YSN 

9 

0- 

EU32CS 

9 

EU3ZSN 

0 

ELM3> 

9 

p 

ELADOT (3) 

9 

EL 4 YCS 

9 

euaysn 

9 

9 

EL42CS 

9 

EU4ZSN 

9 

EMK 696 ) 


common 

FAT (3) 

9 





9 

FEE ( 6 ) 

9 

FEED ( 6 > 

9 

FFF(3) 

9 

9 

FFJ(3) 

9 

FLAGi 

9 

FLAG2 

t 

.9 

. FLAG3 

9 

FUG4 

9 ' 

FNi 

9 

9 

F 0 < 3 > 

9 

FOi (3) 

-9 

FOg ( 3 ) 

9 

9 

F03(3) 

9 

FI (3) 

0 

Fll (3) 

9 

9- 

FPT(S) 

9 





9 

FX2(3) 

9 

F13 (3) 




COMMON 

GASNUG). 

9 

G3 

0 



9 

G3D0T 

9 

04 

9 

G4D0T 


COMMON 

H (3) 

9 

HCMG (3) 

$ 

HOOT (3) 

9 

9 

MS (3) 

9 

W0(3) 

* 


9 

9 

HI (3) 

9 * 

HSPOOT (3) 

9 

HlPRlM(3) 

• 9 

P 

H3P R SM{3) 

9 

HAP r IM{3) 


■ - 


COMMON 

XB2F- 

9 

l CFA 

9 

XCFB 

9 

#■ 

ICFC- 

9 

? CFO 

9 

IDOCK 

9 

9- 

lOOF.-(^) 

9 



< - 


»• - 

SG r aVF 

9 

iPNOCM 

9 

- iPNTeK 

9 

9 

SPRINT 

9 

JPROPF 




COMMON 

NCASE 

9 

NCHECk 

9 

ndeck 

9 

9 ‘ 

ngain 

9 

NUMCMG 




Common 

omega i 

9 

qmeg a 3 

* 

0MEGA4 


COMMON 

PEN03L 

9 

PEND*t 




COMMON 

Q(4«4) 







COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COHMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

cOmmc 

COMMC 

COMMC 

COMMC 

cOmmc 

COMMC' 

COMMC 

COMMC' 

COMMC 

COMMC 

COMMC 
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COMMON 

R 

* 

R0<3) 

0 

81*3) 

9 ccmmc 


R1D0T(3) 

* 

RIYCS 

9 

RIYSN 

9 COMMC 

* 

■ RlZCS 

9 

RlZSN 

9 

R2.<3) 

9 COMMC 

• 

f^2DO T <3) 

•9 

RgYC$ 

9 

R2YS N 

• COMMC 

* 

R2ZCS 

» 

R2ZSN 

t 

R3(3) 

* commc 

« 

R3DOTO) 

9 

R3YCS 

* 

R3YSN 

9 COMMC 

• 

R3ZCS 

9 

R3ZSN 

9 

R4(3) 

* COMMC 

e 

R4DoT(3) 

9 

R^YcS 

9 

R^TSn 

9 COMMC 

« 

R4ZC3 

» 

R4ZSN 



COMMC 

COMMON 

S 

f 

SOOT 

9 

S2NFEJ 

9 COMMC 

• 

« 

SINTTJ 

SlNTTg 

9 

9 

S2NTT0 

SINTT 3 

9 

9 

SINTTl 

SINTY 4 

9 COMMC 
« COMMC 

# 

SP 

9 

SUM I 

9 

S UMg 

e COMMC 

# 

SUMS 

9 

$2<3> 

9 

S3 <3> 

9 COMMC 

♦ 

§40) 





COMMC 

COMMON 

T<3*3) 

9 

TC(393) 

9 

TEMPI <3) 

9 £OMMC 

« 

TEMP2 0J 

9 




COMMC 

« 

TEMP3(3> 

9 

T£MP4<3) 

9 

TEMP5(393) 

9 COMMC 


TEMP6<3»3) 

9 

T£MP7(393) 

9 

TEMP8<393) 

9 £©MMC 

« 

TEMPf<3^3> 

9 

TEMPAQ(3f3> 

9 

TEMPll <3p3) 

0 COMMC 


TemPJ2 (3?3) 

9 

TEMPi3(3. 9 3) 

9 

TEMPi4(3p3) 

9 COMMC 

« 

TEMP|5(3t3) 

9 

TERMi {3 > 

9 

TERMS (3) 

0 COMMC 

0 

tfrict 

S> 

THATM&) 

9 

THATA0<6> 

9 COMMC 

$ 

THETAl 

9 

THETA3 

9 

THEfA4 

9 COMMC 

« 

THETO 

9 

TIB0<3,3) 

9 

TlSoj (3®3> 

9 COMMC 

* 

time 

9 

TJ 

9 

TJUIO) 

0 COMMC 

* 

TJ2U0) 

f 

TJ3U0) 

9 

TJ4(lO) 

0 COMMC 

# 

TMOtOR 

9 




COMMC 

4 

T0EP(3J 

9 

TOTM^S 

9 

T01 

9 COMMC 

4- 

TQ0Q(3) 

9 

TQoP < 3 ') 

9 

T8lG(3) 

9 cowsae 

4 

|Q1P{3> 

9 

TSTART 

0 

TSTOP 

9 

» 

moot 

9 

TT3Q0T 

9 

tt^oot 

0 COMMC 

« 

TlEF(3) 

9 

T13 

9 

TJ4 

COMMC 

COMMON 

V (3) 




Wl (3) 

COMMC 

COMMON 

W0<3) 

9 

WS 

9 

0 COMMC 


W3(3) 

9 

W4< 3) 



cOmmc 

COMMON 

X(6eT) 

9 

XC 

9 

XCDOT 

9 COMMC 

* 

XMU 





COMMC 


COMMC 


# 

* 

*• 


FFFU> s O 0 

CMS 

CMS 

FFF-(37 « 0 9 

CMS 

FFF43) a Qc 

CMS 

00 5 M«l&3 

CMS 

00 5 N»le3 

CMS 

E 6 EIM 0 N) « 0. 

CMS 

s continue 

Cm© 

J.~»: 0 

CMS 

10 J*v» J * 1 

CMS 

IfjMJ oQT « nUmcmg) Return 

CMS 

IF U DOF <U1 oNEs 0 ) 00 TO 20 

CMS 

Ftfjtn « AoCJ(J9l»3^HW(U> 

CMS 

FFU(H) ^ AOCJ(Je2931*HW<J) 

CMS 

FFJO) « A 0 CJUc393)PH«(J) 

CMS 

DO IS Marl *3 

CMS 

00 iS Ns! 9 3 

CMS 

esy-WfN> -»• o 6 

cmg 


C-23 



19 CONTINUE 
00 TO 6 s 

20 IF(lDOF(J> ,NE, l) 00 TO 35 
SXNTTj ■ Sjn(ThaTa(J> ) 

COSTTw) « COS(THATA(J>) 

SlNFEj a SIN(FEE(J)) 

COSFEJ ■ COS (FEE (J)) 

T£MPJ2 ( 1 ) m C0STTj«Ali<Jtli2)#THATAD(j) 

* *SlNTTj#AII(J»3*2) ttT HATAD{j) ♦ H*(J)*SInTTj 
TeMPU(2) * SINrEU»SlNTTJ*AII<J*l*2>#THATAD(J) 

* ♦C0SFEj«An(J,2,2)*THATA0(j) 

* *SlNFEj*C0STTj# A jj(j f 3 f 2)«THATAD<J> 

TEMP12(3> »-SINTTj*C0SFEJ 4 »AU(J*l*2> < »THATAD<J) 

* ♦SINPEU*AI! <J*2»2)#THATA0(j) 

* ♦C0SFEU*C0STTj«AtI(J*3»2)#THATAD(J) ♦ HW(JJ#cOSTTj 


00 22 Mill 1 3 

FFJIM) a A 0 Cj(J*M*l>*TEMPl2a) ♦ AoCj ( j # m*2)6tEMP12(2) 

* ♦A0CJ(J*M*3)*TEMP12<3) 


22 CONTINUE' 
TEMPl3a»l) 

» 

TEMPi3<i*2) 

♦ 

TEMP13 (1*3) 

# 

TEMPl3(2ol> 

T£mP13(;;*2> 

TEmP13(£*3) 

T£MP13(3»1) 

♦ 

TEMPl3( )* 2 ) 


a CQSTTJ#A0CJ(J*1*1) ♦ Sinfej#SINTTJ # AoCJ( J* l*2) 
-SlNTTj# c oSpEj«AOCJ<J*l»3) 
a COSTTJ«aOCU(J*2*D ♦ $InFEJ*SINTTJ*A0CJ(J*2*2> 
-SINTTJ«C0SFEJ«A0CJ<J*2,3) 

a CQSTTj#a0CJ(J»3*U ♦ $InFEJ*SinTTj*AOCJ( J* 3*2) 
-SINTTJ#cOSFEJ#AOCJ(J»3.3> 

B C0SFEU # A0CJ(J # 1»2) ♦ $1nFEJ*A0CJ<J»1»3) 

S COSfEJ*AOCJ(J, 2 * 2 ) ♦ Si N FEJ*AOCJ< 0,2,3) 
s C0SFEU*A0 CJ(sJ* 3*2) * Sl N FEJ*A0CJ U»3 f 3) 
a §INTTJ»A 0 CJ(J* 1 * 1 ) - SlfgFEJ*COSTTU*AoCJ( J* 1*2) 
♦ C0SFEU*C0STT j» AOC J ( J » 1 * 3 > 
a ^iNTTJ^A0CJ(J*2*l) - SlNFEJ*C0STTU*A0CJ<J*2*2) 


* ♦COSFEU^COSTT J*AOC J ( J * 2 * 3 ) 

TEMP13 (3*3) or S1NTTU#A0CJ(J*3»1) - SInFEJ*COSTTJ*AOCJ( J*3,2) 

* *COSfE-J^COSTTJ*AOCJ( J* 3*3> 

Do as- Mai *3 


DO 25 N*>1 *3 
TfcMPlA (M*N) 

• 

25 CONTINUE 
TEmP15(1*1) 
T&MPlS (1*2) 
T£MPl5(l.t3) 
TEMP15(2*1) 

♦ 

TEMPl5(2*2) 

* 

TEmP15(2*3) 

« 

TEMP 15(3,11) 

* 

TEMP15(3*2) 

#• 

TEMPl5-(3ti) 


a AIS(U*M,1)«TEMP13(1*N> ♦ AI I < J*M*2) *tEMPl3<2»N> 
«AH ( J*Mfl3)<*TEMP13 (3*N> 

a C0STTJ*TEMP14U*1) ♦ SiNTTj*TEMPl 4 ( 3 f 1) 
a C0 STTU»TEmP 1A<1»2) ♦ Sf NTT J*TEMP1^ (3. 23 
a C0STT^#TEMP14(1»3) ♦ StNTTj*T£MP14 ( 3, 3) 
a SINF£J*SINTTJ*TEMP14(1.1) ♦ C0SFEJ«TEMP1A(2*1> 
-SINFEJ*C0 STTj#TEmP1A (3, 1 ) 
a 5 InFE 0 <*SINTTj#TemP 14(^2) * C0SFEU*tEMPl4 <2*2> 

-SlNF£J«C0STTjeTEMPl4(3 f 2) 

SJnPEJ#SINTTJ#T£mP 14 ( 1,3) * C0SFEJ«fEMPl4(2*3) 
-SXNFEJ*C0 STTj#TemP14(3,3) 

SINTTJ#C0SFEJ*TEMP14(1,D ♦ SINF£J*TEMP14<2*1> 
♦CQSFEv)*CQSTT,J*T£mP14 O', l ) 

« «.$XnTT,j*cOSfej«TemP 14(1 # 2) * SlNF£J*TEMPl4 (2*2) 
*COSFEU<»COSTTJ«TEMP14(3*2) 
a -$INTTJ#C0SFEJ*TE*JP14(1,3) * SINFEU^TEMPl* (2*3) 
«C0SF£J#C0STTj#TEMPl4(3 t 3) 


DO 30 Mai *3 
DO 30 Nal * 3 

EBO(M*N) « A0CJ(U*M*l)^TEMPi5(l*N) ♦ A OCU ( J»M*2 ) *TemP15 (2*N) 
* *A0CJ(J«M?3)«TEMP|5(3*N) 

30 CONTINUE 
00 To'- 60 


35 CONTINUE 

SiNTTj s SXN(THATA(v() ) 


CMO 

CMG 

CMG 

CMO 

CMG 

CMO 

CMO 

CMG 

CMG 

CMO 

CMG 

CMG 

CMG 

CMG 

CMO 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMS 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

QMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 

CMG 
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COSTTJ a CoS(THATA<J>) QMG 

SINFEJ a SlNtFEEUU CMG 

COSFEj s CqS (FEE (J)) CMG 

TEMPI U) s Ai0U?l»l)*PEEDwi „ CMG 

Tempi ( g) a COSfEJ»AIO(J ? 2»1)«FEEO(J> - SXNFEJ*A 50 <j f 39 l>»FEED<J> CMG 

TEMPI (3) a SINFEJ«AXO(j929i>*FEED<J> ♦ COSFEJ*AJU ( J?3« D *FEED< J) (*MG 

TEMP2 ( 1 ) bCoSTTJO (AlKjtltl) *COSTTJ«FefD < J) ♦ A I I g« l ,2) »THAtAd ( J) * CMG 

* All (J^1*3 >«SinTTj«FEE 0<J) )*SlNTTj«(AiI(J*3»l)»COSTTjop E: eo(J)* CMG 

* AU (Jc392)«?HATAQ(J) *AIX<J»393>#SINTtJ*FEE0(J> > CMG 

TEmP 2 (2) 3SINFE J^SJNTT JO ( An ( Jf 1 ♦ i ) «CosTT J*FEED ( J) ♦ CMG 

* AXS W*i?2l«THATAD(J}*AX!U9l93>*SlNTTJ«FEEDU* )* CMG 

» COSFEJ»(AXI(^e29X>°CO§TTJ*FE€D(J)«Ali(J92*2)*THATAD(J)* CMG 

* All ( J92»3)«SINTTJ<*P£ED< J) )- . CMG 

* S-X-WFEJ#COSTT X ( J«3o l) ^COSTTj^FEEp ( J) * A 1 1 ( J®3»2) *ThaTaO< J) ♦ CMG 

« All ( Jc3e3) asiNTTj^FEED ( J) ) ■ CMG 

TEMP2 (3) c ’ H, SJNTTJ o C0SF£J* <AJ i ( J? 1 *1 ) ^CqSTTJ^FEED ( J) ♦ CMG 

* AII(J»X*2XOTHATA0<J>*AXKJ«l93>*S!NTTj«F£ED<jn* i CMG 

* SlNFEJ«(AXt(J»geU^C0$TTJ*FE£0(J)*Alf(J*2,2)*THATAO(J)« C«G 

* -AS}(Ja2t3i<«SXNTTj«FEED(J) )♦ CMG 

* C0§FEJsC0STTj*MAU(J?39 1)*C0STTJ*FEE6<J>*AIIU*3*2)*ThaTad<J>* CMG 

* An(j63e3)oSINTTj»FEeO(J) > CMG 

TEMP3C1) o HW ( J) ^SlNTTJ CMG 

TEmP 3(2> a '•HWtJ>*COSTTj«SXNFEJ CMG 

TEMP3 (3) b MW(J>«COSTTJ«COSFEJ CMG 

TEMP+U) 3 TEMPI ( 1 ) ♦ TEMP2<1> ♦ TEMR3(1) CMG 

TEmP 4(2) a Tempi (2) ♦ T£mP2<2> * T£MP3<2) CMS 

TEmRA (3) O TEMPI (3) * TEMP2<3> ♦ T£MP 3 < 3 ) CMG 

FFJil) a AoCJU»l*l>*TEMP*U) qM 0 

* «A0CJ( J»1o 2)0-TCWP4-(2) * AOQJ( j?» l f 3) *T£mP4<3) CMG 

FF J ( 2 > .s A0 CJ< Jp§* U^TCMPA tl) CMG 

» +AoCj(J»' 2 « 8 mEMP*( 2 ) * AqCJ( j 9 2 * 3 )*TEMP*< 3 ) CMG 

FF J < 3 } e A0&JUt&rl)»TEMP4(l> CMG 

* oAoej(Ji>3»H) 0 .TEMP4(2) ♦ AOCJ ( J*3»3> #TEMP4<3> CMS 

TEMP5(1 9 1) s A0Cj(J9X 9 J) . CMG 

TgwRSdsS) g AOCj(Jo2®U CMG 

TEmPS ( X c 3) o AOCJ ( Jo3» X > CMG 

TEmPS<2:pS) a CO§FEU°AOCJU9i»2) ♦ S| N FEJ#A0CJ ( J*l 93) CMG 

TEmR§<2*2) s C0SpEJ®AOCJ(J 9 292> * $XnFEJ«AOCJ < J t2*3) CMG 

TEMP5(2?3) 3 CO^F e ^AOCJ<J*392) * SInFEJ®AOCJ < J»3,3) CMG 

TEMPS (3? i ) « «SXNF£J«A0CJ(J 9 1»2) * CosF£J*AOCJ ( J» 1 »3> CMG 

Temps ( 3,2) -g «SXNFgJ«A0CJU 9 2»2) ♦ C0SFEJ*A0CJ(J9293> CMG 

TEMPS <3* 3) -a «SSNFEJ*aOCJ<J 9 3»2) ♦ COsPEJ*AOCJ( J»3,3> £MG 

00 ^0 MoX»3 CMG 

DO 40 Nol?3 iCMG 

TEMPG(MpN) o A|0(j9M91)#TEMRS(ltN> ♦ aI0< J*M«2)»TEMP5'(2'N> CMG 

« ♦A|0(J»M»3) < 4TEMpS(3 f N> . CMG 

*0 CONTINUE . CMG 

■tempt a# i) « temps-uoD . cmg 

TEMP?(So2 > •« TEMR©(le2) CMG 

TEMP? [% 9 d) ,* <TEMp6(&*3) CMG 

TEMP?(g 9 i) o cUSFEU»TEMP6(2*J) - SINpEJ*TEMP6<3t i ) CMG 

T£mP 7(2«2) ® cOSpEU^TEMPG (g»2) «- SXNfEJ*TEMP6 (3*2) CMG 

TEMP7{2 9 3> o C0Spg*J*TEMP6(2 # 3) - 5 XNfEJ*7EMP©<3* 3 ) CMG 

TEmP7{3 0 X) c §XNP6U4>T£MP©<2*i> ♦ CQSFEJ«TEMP6 (3? 1) CMG 

TEMP7{3g2) -g S|NPEU»TEMP6(2 f2) ♦ C0SfEJ*TemP6<3»2) CMG 

TEMPT ( 3 9 3) s SlNF£0«TEMP612*3) ♦ C0 SfEJ*T£MP6<3*3) CMG 

Temps a, i) s costtjoaocjUvIoI) ♦ sinfej«sinttj*aocj<j 9 i» 2 ) cmg 

* aSxNTTj«C0SFEJ*A0CJ(Jti»3) CMG 

T£MP8( 1 92) s C0ST7-U«A0CJ<J*2*i) • SXNFEJ*SINTt-J*AOcJ(Jf 2 * 2 > CMG 

? -siNTTJ#C0SFEj«A0CJ'(Jt2»3) CMG 

T£MP8-(1 9 3) a COSTTj^AOCJt J»3» l) ♦ SXNpEJ#SlNTTj*A0cj<si9392) CMG 

*' ■ «s intt-u^cosfe J^AOCU ( U 9 3 * 3 ) CMG 
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TEMP8(2*l> ■ C0SFEJ # A0CJ<J»1*2) * SlNFEJ*AOCjt CMS 

TEMP8 (2*2) * C0SFeJ*A0CJ(J*2.2> ♦ SINf£J#A0CJ(J*2*3> CMS 

TtMp8(2 f 3> • CqsFEJ#A 0 CJ(J 9 3*2) ♦ SJNFEJ<*AoCJ ( J*3*3) CMS 

TEmPQOpD b SjNTTj#AOCJ(J9l9i> * SINfEJ*C0STTj#A0CJ< J* 1*2> CHS 

* ♦COSFEJ # COSTTJ#AOCJ(Jols3) a . CMS 

TEMP8(3,2> * SINTTU^AqCJ ( J* 2* 1 ) « SlNFEJ»COSTTJ* A OCJ ( J»2*2> CMG 

* *C0 s FEJ*C0STTj# A 0CJ<Jf2*3) CMG 

TEMPS (3*3) ■ SINTTU*AQCJ(J*3*D *■ SlNFEJ*COSTTJ*AOcJ ( J*3*2> CMS 

* *CaSFEJ # CoSTTjOAoCJ<J*3»3) CMG 

DO AS Me 1*3 CMG 

DO AS Ns 1*3 CHS 

TEMP9(M»N> 9 AH<J*Mtj) #TEMP8 ( 1 »N) ♦ All<J*M*2)«TEMPS.(2*N) C MG 

* *A I X (J*M*3)*TEMP8(3*N) CHS 

AS CONTINUE CMG 

TEmP 10(1*1> « C0STTJ*TEMP9(I, J) 4 SlNTTU#TE<1P9(3*l) CMS 

TEMPlO(l *2) * C0STTj#TEMP9(l,2) ♦ 5 XnTTj#TemP9 (3*2) CMG 

TfcMPlO (1*3) 9 COSTT J*TEMP9 ( J * 3 ) o SANTTJ*T£<!P9 (3*3) CMG 

TEMP10(2*l) a SINFEJ«SINTTJ«T£MP9(I*I) ♦ C0SFEJ*TEMP9'<2*1) CMG 

* -SlNFEUOC0STTjiT£MP9(3*l) $MG 

TEMPI0(2»2) a SINFEJ»SINTTJ«TEMP9(1*2) ♦ C0 SFEJ»T£mp 9'(2*2) gMS. 

* -SlNFEJ^C0STTj4>TEMp9(3t»2) CMS 

TEmPJO ( 2*3) e SJNF£sJ # SINTTj4TEMP9 (1*3) o C0 SFEJ* t EmP9<2*3) c«g 

* -SINF£J*C0STTJ®TEMP9(3*3) CMG 

TEMP10 (3*1) «-SINTTJ»C0SPEsJ»TEMP9a*l) 4 SXNFEJ*TEmp9'(2*1) CMG 

* *C0SfEJ*C0STTj«TemP9(3*1) CMG 

TEMPlO (3*2) »-SXNTTj»cOSFEjaTEMP9U*2) * SINFEJ*TEMP9'(2*2) CMG- 

* <-C0SFEJ*C0STTJ*TeMp9(3.2) CMS' 

TEMPlO (3*3) «~SINTTj«cOSPEjoTEMP9U»3') * SINFEJ*TemP9 (2,3) CMG 

* «C0SFEJ#C0STTJ#TEMP9(3»3) CMG' 

DO 5o Ms l *3 CMG 

00 50 Nisi *3 CMG- 

TeMPii(M*N) o t£MP7(M 9 N) * T£MPlO(M*N) CMG 

50 CONTINUE CMG 

DO 55 Mel*3 CMG 

DO 55 Nsl*3 CMS 

EEU(M*N) t* AOCj(J*M»i)»TEMPn U*N) * AOC J ( J*M*2) #TEMPU1 (2*N) CMG 

* <.AOCJ(JeM 9 3S»TEMPn (3*N) CMG 

55 CONTINUE CMG 

&0 THATA(O) a THATA(J) ♦ THATAD ( J) #D£i,TAf CMG 

FEE(J) s FEE(J) ♦ FEED(J)«DELTAT CMG 

65 CONTINUE CMG 

DO .rO M«1 *3 CMG 

FFF(M) 9 FFF(M) 4 FFJ (M) , CMG 

70 CONTINUE CMG 

00 75 Mai *3 CMG 

00 75 Nel t 3 CMG 

EEE'(M*N) a ^ee(M*N) ♦ EEU(McN) CMG 

75 CONTINUE CMG 

GO TO 10 ' CMG 

.... CMS 

##<>■»»##*• «•»*«■«#•*»■»»««**«*«**«***#**« 
#• 

#■ ’ 

END 
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SUBROUTINE EMCAUC 
» 

* 

ft 




common 

A (3) 

9 

AE(S) 

9 

AEO(S) 

9 COMMC 

ft 

AFOUR (2) 

0 

AII(603i.3) 

9 


COMMC 

ft 

Axo(^53 9 3) 

t 

AJ1(3) 

9 

alt 

0 COMMC 

ft 

AQCU (0*3e3) 

9 

AOJ (3) 

9 

AONE (7) 

9 COMMC 

ft 

ATCPT2{3?3) 

9 

ATHREE (5) 

9 

ATB0(4) 

0 C6HMC 

ft 

Al(3*3) 

9 

A1J(2) 



COMMC 

COMMON 

BOMAS® 

9 

8F0UR<2) 

9 

BMOM 

9 COMMC 

ft 

80DYDX <393) 

f 

80DY0J {3»3) 

9 

BODYlI (3o3) 

9 COMMC 

ft 

BOMASS 

9 

BONE (7) 

9 

BTHREE(S) 

9 COMMC 

ft' 

BTW0<4) 

9 

bimass 

9 

B2MASS f 

0 COMMC 

ft 

-B3MASS 

9 

64MASS 



COMMC 

COMMON 

CA (3) 

9 

CB<3> 

9 

CSAINOO) 

» $ommc 

ft 

CQAjNl (2) 

9 




COMMC 

ft- 

COSFEJ 

• 

COSTTj 

9 

COSTTQ 

0 COMMC 

ft 

C0STT1 

9 

COSTT 3 

9 

C0STT4 

9 COMMC 

ft 

C02T 

9 

7 CPI 

9 

CP2 . 

9 COMMC 

4 - 
* - 

CST 

9 

Cl 



0OMMC 

common 

08(3) 

9 

0001(3) 

0 


0OMMC 

ft 

DELTA? 

9 

001(3) 

* 

OOIOOT (3) 

9 COMMC 

ft 

OTI (3) 

9 




COMMC 

ft 

DTI ME 

9 

D12 (3) 

0 

013(3) 

9 COMMC 

»• 

0I300T(3) 

9 

D13YCS 

9 

D13YSN 

9 COMMC 

ft 

oiszes 

9 

0132% 

9 

014 ( 3 ) 

9 COMMC 

ft' 

014D0TO) 

9 

D14YGS 

9 

014YSN 

9 COMMC 

ft 

014ZCS 

* 

0J4ZSN 



COMMC 

COMMON 

EEE (303) 

9 

£E J ( 3 » 3 ) 

9 

ELE < 3) 

9 COMMC 

«■ 

EL2D0T (3) 

9 . 

EL2YCS 

9 

ELEYSN 

9 QOMMC 

ft- 

EU22CS 

9 

EL2ZSN 

9 

EL3(3) 

9 COMMC 

ft 

EL3DQ T (3) 

9 

EL3YCS 

$ 

EL3YSN 

9 COMMC 

ft 

EU3ZCS 

» 

EL3ZSN 

9 

EL4(3) 

9 COMMC 

ft 

EU00TO) 

9 

ELAYCs 

9 

EL4YSN 

0 COMMC 

ft 

EL4ECS 

0 

EL4Z% 

9 

£M’(6 0 6) 

COMMC 

COMMON 

PAT(0) 

9 




COMMC 

ft 

FEE (8) 

9 

FEED (6) 

9 

FFF (3) 

9 COMMC 

ft 

FFJ< 3 > 

9 

F.LAOl 

9 

flags 

0 COMMC 

ft 

FLAGS 

9 

FLAG4 

0 

FNi 

9 COMMC 

ft 

FO < 3) 

9 

F0l(3) 

9 

F02 ( 3 ) 

0 COMMC 

ft 

F03(3) 

0 

FI (3) 

9 

FI 1 (3) 

9 50 MMC 

ft 

FPT{S) 

0 




gOmm< 

ft 

F12 (3) 

f 

F13 (3) 



COMMC 

COMMON 

gainUo) 

0 

©3 

9 


COMMC 

o 

G3D0T 

0 

64- 

9 

6400? 

gOMMC 

COMMON 

H<3). 

0 

HCMG<3) 

0 

HDOT (3) 

0 COMMC 

ft 

HX<3) 

9 

HO (3) 

9 


0 COMMC 

ft 

Hi (3) 

9 

HlPOOT(3) 

9 

H1PRIM(3) 

0 COMMC 

ft 

H3P*IM<3) 

9 

MERINO) 



COMMC 

COMMON 

IB2F- 

9 

IGF A 

9 

tCFB 

0 COMMC 

ft' 

JCFC 

9 

JCFD 

0 

idock 

9 COMMC 

ft 

JtDOF<&) 

9 




Cqmmc 

ft 

‘ I0RAVF 

9 

IPNOLM 

9 

IPNTCK 

e COMMC 

ft 

IPfiiNT 

9 

IPROPP 



COMMC 

COMMON 

NCASE 

9 

NCHECk 

9 

NOECK 

9 COMMC 

ft 

NGAjn 

9 

numCmg 



COMMC 

common 

OMEGA i 

0 

OMEGA 3 

9 

0MEGA4 

COMMC 

common 

FEND3L 

0 

PEND4L 



COMMC 

COMMON- 

Q ( 4 s 4) 





COMMC 
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. COMMON 

R • n • i ♦ . 

RO (3) * 

»M3) 

* COMMC 


RlDOT(ls) ! * 

R1YC$ , 

RIYSN 

* qOMMC 

#■ 

RIZCS * 

RlZSN f 

R2*3> 

* COMMC 

* 

R2DQTO) * 

R2YCS , 

R2YSN 

f COMMC 

* 

R2ZC9 * 

R2ZSN » 

R3(3) 

* COMMC 

« 

R3D0T(3> « 

R3YCS * 

R3YSn 

* COMMC 

4 

R3ZCS » 

R3ZSN • 

R4<3) 

* COMMC 

* 

R4D0TO) f 

raycs . 

RAYSN 

* COMMC 

4 

R4ZCS f 

R4ZSN 


COMMC 

COMMON 

S » 

sdot t 

SINFEJ 

* COMMC 

» 

SJNTTJ • 

SXNTTo ♦ 

SINTTI 

• COMMC 

# 

SINTT2 # 

SINTT3 * 

SXNTT* 

* COMMC 

4 

SP ♦ 

su M i » 

SUMg 

* COMMC 

4 

SUM3 ♦ 

S2 ( 3 ) t 

S3 (3) 

t COMMC 

# 

COMMON 

$4(3) 

T (3*3) * 

TC(3t3) 9 

TEMPI (3) 

COMMC 
t COMMC 

# 

TeMP2<3) ♦ 


COMMC 

#■ 

TEMP3 13) „ * 

TEMPAO) ♦ 

T£MP5<393) 

t COMMC 

# 

TEMP® (3»3) * 

TEMP7 (3*3) * 

TEMP 8 (3*3) 

t COMMC 

4 

TEMP9(3*3) * 

TEMPiO (3f3) 9 

TEMPll (3*3) 

* COMMC 

4 

TEMPl2(3f3) » 

TEMPi3(3»3) f 

TEMP14(3*3) 

t COMMC 

4 

TEMPiS (3*3) * 

TERMiO) * 

TERM2<3> 

9 COMMC 

#■ 

TFRiCT » 

THATA( 6 ) , 

ThATA0(6) 

f COMMC 

# 

thetai * 

THETA3 , 

THETA* 

* COMMC 

* 

theto ♦ 

TI80 (3*3) * 

TlBOj (3*3) 

* C°MMC 

# 

TIME 9 

TJ 9 

TJ1U0) 

* COMMC 

t 

f J 2 ( 10 ) . » 

TJ3 1 1 0 > * 

TJ*<10) 

* COMMC 

4 

TMOTOR * 


* 

COMMC 

4 

TOEF (3) * 

TOTMAS ♦ 

T 01 

* COMMC 

* 

TQ0G(3) » 

T00PO) 9 

T91GO) 

» COMMC 

#• 

Tq1P<3) * 

TSTaRT , 

TSToP 

* COMMC 

• 

TT1Q0T t 

TT300T * 

TT4D0T 

9 COMMC 


T1EF (3) * 

T13 , 

TI4 

COMMC 

COMMON 

common 

V (3) 

WOO) • 

ws * 

Wl (3) 

COMMC 
♦ COMMC 

» 

W3 (3) « 

W4(3) 


COMMC 

COMMON 

X(0 9 7) * 

XC ' , 

XCOOT 

* COMMC 

* XMU COMMC 

COMMC 


« 


#- 


EMCAl 

The: following calculations will be used Repeatedly to< calculate m em£al 


sintti « s;iN< theta d 

C^STTi * COS(Th?Ta1) 
OOgT a COStTI«*2 
GST » COSTTI«»SlNTn 
SlgT « SlNTTl##2 
RiYCS * Rl(2)*C0STTl 
R2VC3 » R2(2)*OOSTT1 
R3YC8 « R3(2)#Q0STTi 
R4YCS » R4(2>*COSTU 
RIZCS n RI(3)*C0STT1 
RgZCS it R2(3)*C0 STTi 
R3ZCS a R3 (3) *COSTTl 

RAZCS e R4(3)#C0Sm 
R ; 1YSn s R1(2)bSinTTi 
R2YSN * R2(2>*STN?T1 


EMCAl 

EMCAt 

EMCAL 

EMCAL 

EMCAL 

EMCAL 

EMCAL 

EMCAj. 

EMCAL 

EMCAL 

EMCAl. 

EMCAL 

EMCAL 

EMCAl 

EMCAL 

EMCAL 
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H3/SN = H3(2)*SINTT1 EMCAL 

R4YSN = H4(2)*sINTTi EMCAl 

HiZSN s Ri<3)#SlNTTl EMCAl 

KdZSN = «2(3)*SINTTl EMCAL 

K3ZSN = R3(3)*SINTU EMCAL 

H^ZSN = «^{3)*slNTTl EMCAL 

EL2YQS = EL2(2)*C0STTj EMCAL 

EL3YCS S EL3(2)*CoSTTl EMCAL 

EU^YCS = EL^< 2 > w COSTTl EMCAl 

EL2ZCS = EL2(3)*CoSTTi EMCAL 

fctaZCS = EL3(3)^C0STTi EMCAL 

EU4ZCS = £l,4<3}*C0STTl EMCAl 

EE2YSn = EL2(2)*SinTTi EMCAL 

EL3YSN = EL3 ( 2 ) *SjNTT l EMCAL 

EL4YSN = EL^(2)*SlNTTl EMCAL 

EL2ZSN s EL2(3)*SINTTl EMCAL 

EL3ZSn = EL3{3)*SinTT. 1 EMCAL 

tL4ZSN = EL4 (3) *SjNTT J, EMCAL 

013YCS = Dl3(2)#CoSTTl EMCAl 

0L4YCS a Dl4 (2 ) *CO sT Tl EMCAL 

Di3ZC$ = Dl3(3)#C0STTi. EMCAL 

U14ZCS a Dl4(3)*CoSTTl EMCAl 

D13YSn = D13(2)* s INTTi EMCAL 

DUYSN = D14<2)«SINTTI EMCAL 

U13ZSN = 0l3(3)*SlNTTl EMCAl 

Di4ZSN = 014(3 )* s INTTi EMCAL 

dMOMsBOMASS/TOTMAS EMCAL 

EM ( 1 t 1 ) sBODYOI < 1 » 1 ) ♦BODY! I (1*1) +BlMAss*D01 (2>#{R1 YcS**R1ZSn) + EMCAL 

* BiMASS*00H3)*( R 1YSn+R1ZCS)*82MASS*(R2YCS*R2ZSN)*(00‘1 {2)*EL2YCS« EMCAL 

* EL2ZSN)+«2MASS*<R2YSN*R2ZCS) # (D0l (3) ♦EL2YSN+EL2ZCS) +B3MASS*.(R3YCSEMCAL 

* -«3ZSN) *(D01 <2) +01 3 YcS’*D13zsN*EL3YCS-EL 3 ZSN)*b3mAss» (R3YsN-!-«3z c S) EMCAL 

* *(001 ( 3 ) >O13YSN*0i3ZcS*EL3YSN+EL3ZCS) +84MASS*<R4 Yc.S.R4ZSn) * EMCAL 

* (001 (2) ♦0],4YCS-Dl4ZSN+EL4YCS*’EL4ZSN> +B4MASS* (R4 Y$n* R4ZCS) * EMCAL 

* (001 (3) ♦0l4YSN+0l4ZCS*EL4YSN*£l 4 ZCS) EMCAl 

C - * EMCAL 

£M ( i t2) -BODYOI ( 1 *2) +bODYlI (i *2) *COSlTi-BODYlI (1*3) *SINTT1 EMCAl 

* -8lMASS*Rl (1) *DOl (2)«. EMCAl 

* b2MASS*R2(l)*(00l (2>*EL2YCS~EL2ZSN>- EMCAL 

* b3MASS*R3(l)*(00i (2)+D13YCS-013 ZSN+El 3YCS-EU3ZSM)- EMCAl 

* t54MASS*R4(l)*(D0ll2)+D14YCS“014ZSN*£ L 4YCS-EL4ZSN) EMCAL 

C EMCAL 

EM(l,3)s800Y0l (1*3) ♦B0DYlI(l»2)*SlNTTl*B0DYlI (1»3)*C0STT1 EMCAL 

* -8imASS*R1U>*001(3)- EMCAl 

* 02MASS#R2 ( !)<»( DO 1 (3)^EL2YSn*EU2ZcS)-. EMCAL 

* b3MA$S*R3 ( 1 ) (OOl (3) ♦013YSN*D13ZCS*El3YSN+EL3ZCS) • EMCAL 

* b4MAsS*R < M D* (001 (3) +D14 YSn+01AZCS*El4YSN*ElAZCS> EMCAl 

C EMCAl 

EM ( 1 * 4) aSOpYU ( 1* 1)-B1MASS*001 ( 3) # (8M0M*D0 1 ( 3) -R 1 Y$N-R 1ZCS) * EMCAL 

* OiMA$s*Ooi (2)*(R1YCS*R1ZSN-BM0 m*D01 (2) >" EMCAl 

* tdZMASS# (001 (3) *El2YSn*EL2ZcS) »(BMOM*nOH3) -R2YSN-R2ZCS) ♦ EMCAL 

* t*2MASS*<001 ( 2 ) +EL2YCS-EL2ZSN)*(R2YCS-R2ZSN-BMOM ft Doi'{2) )- EMCAL 

* B3MASS*(001 (3)*(013(2)*El 3(2) )ttSINTTl+(0l3(3)*EL3,(3) >#C0STT1)* EMCAl 

* (BM0m*[}0i (3).R3YSh-R3ZCS) + EMCAL 

* H3MASS*(001 <2)*(013(2)*EU3(2) )*C0SrTi-(0l3(3)+EL3(3) >*SINTT1)» EMCAL 

* (r3.YCS-R3 Z sn-BMOM*001 (2) )- FMCAl 

* B4MASS» (001 (3) + (014(2) +EL4(2) ) *SinTT 1 + (D14 (3) +EL4 (3) ) «C0STT 1 ) * EMCAL 

* IBM0M*D01 (3)-R4YsN-R4ZCS) + . EMCAL 

* B4MASS*(D01 (2) +(014(2) +EL* (2> ) »C0STT 1- (Dl4 ( 3) *El4 (.3) ) *SInTTI ) * EMCAl 

* (R4YCS-R4ZSN-BM0m*001 (2 ) ) EMCAL 

C „ EMCAL 

Em ( 1 » 5 ) =-«3mAsS*R3 ( 3) * ( $3 { 3) *E|_3 ( 1) -S3 ( 1 > *El3 (3 ) ) + EMCAl 

* b3MASS*R3(2)*('’ S 3(2)*EL3(l)+S3(l)#£L3(2) > ■ EMCAL 
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C E 

Em ( l »6> =»~B4MASS*R4 t3> (S4 (3) *EL4 < 1 ) -S4 ( 1 ) *EL4 <3> > ♦ E 

* t54MASS*R^(2)#(-s4(H)«EL4<l)*S4(l)*EL4(2) ) E 

C E 

EH ( 2 , i)=60DY0X (2» 1 ) ♦ 80 OYII (2* 1 ) eCoSTTi-BoDYlIO* 1) *SlNTTl- E 

* tilMASS«OOl < 1 ) *(RlYcS-RlZSN) - F 

* U2MAS$*(R2YCS-R2ZSN)*(D01 (i>*EL2U> )- E 

* a3MAsS*(R3YCS-R3ZSN)<MU01<i)*Dl3u)+EL3(l))- E 

* b4MASS» (R4YCS-R4ZSN) # (DOU 1 ) *D14 (1) +EL4 ( 1 ) ) E 

C F 

EM (2«2> =SODYO 1(2* 2) ♦boDYl I (2*2) *Co2 T -BODY1I (2»3> *CST E 

* *BO0YlI (3»2) *CST ♦ bOdYII ( 3*3) *SIzT * F 

* blMASS*Rl(l)*D0l(l)*8lMASS*D01 (3)*(RiYSN*RlZCS) + E 

* H2MAsS*R2(1)*(D01 U) +EL2(1> >♦ F 

* b2MASS* (HgySN+R2ZCSj » (DOl (3) *EL2 YSN+eL 2ZC s ) * F 

* U3MASS«R3(l>*(00l(l>«Dl3(l)*eL3(l>>* E 

* t>3MAsS*(R3YSN*R3ZCSM(001<3)*0l3YSN*r)13ZCS+EL3YSN*EL3ZCS)+ F 

* 0aMASS«R4(2)«<DO1U)*D14(1)*S44(1)>* E 

* b 4 MASS*(R 4 YSN+R 4 ZCS)*( 00 K 3 )+ 6 l 4 YSN*nl 4 ZCS*EL 4 YSN*EU 4 ZCS) E 

C F 

EM (2*3) 38 ODYOI ( 2 » 3 ) ♦ 80 OYI I (2*2) *CST *BoOy1I ( 2 . 3 ) »Cq2T F 

* -BOOYiI (3,2 )*SIhT - BOoYli (3*3) *CST •* F 

* blMASS*UOl ( 3 ) #(R1YCS«R1ZSI\I> - F 

* W2MASS*(H2YCS-R2ZSN)*(D01(3)+EL2YSN*EL2ZCS>- f 

* b3MASS*(R3YCS-R3ZSN)*(D0i (3)*D13 YSn*eH3ZcS+EL3YSn*eL3ZcS}«- ' F 

* B4MASS* (R 4 YCS-R 4 ZSN) » (UOi ( 3 ) ♦Di4YSN*nl4ZcS + EL 4 YSN*.El. 4 ZCS) E 

C • E 

EM(2,4)=B0dY 1I (l»2)*C0STTl-80DYinl»3)*SXNTTU8lMASS°00l (1)*R1YCS*F 

* HiMAsS^DOKD^RlZSN^BMONttBiMASS^Ool (D^Dol (2)- F 

* b2MA$S*(D01 ( D+EL2 (1 > )* <R2YcS-R2ZSN-PiMQM#D01 (2) )- f 

o b 3 MASS* (UOl ( l)+0l 3(1) ♦EL.3( 1 ) ) * (R3YC-S-R3ZSN-BMOM*Doi (2) )- F 

* b4MASS»(D01{l)*Dl4(l)*EL^(l))*(R4YCS-R4ZSN-8MOM»t)01 (2) ) F 


e 

EM (2*5) = ( 63MASS*R3 (3) * (»S3 (3) tt EL3 (2) ( 2) *EL3 < 3> > ~ 

* b3MASS*R-S<l)»<-S3t2)*EL3(U+s3U)*EL3(2) ) )*COSTTl- 

* ('-b3MASS*R3( 2 )*<-S»J(3)*EU3(2)*S3(2>«EL3(3) ) ♦ 

* b3MASS«K3U)»(S3(3)*EL3U)-S3(l>*EL3<3) ) >*SINTTi 
C 

EM (2*6) a (B 4M Ass*R4 (3) * (-S4 (3 ) #El 4 (2) *s4 (2) *EL4 (3 > > ~ 

* b4MASS*R4(l)*(->S4(2)«EL4(l)+S4(l)*EL4(2) ) >«COSTU,. 

* (*B4MASS*R4(2>*<-S4(3) tt EL4(2)*S4(2)*FL4(3) )♦ 

* b4MA$s*R^(l)*(S^(3)*EU^(l)-S4(l)*EL4(3) ) )*SINTTl 
C 

EM ( 3* 1 ) abOOYOI <3M> ♦B0DY1K2* !>#SINTTi*BODY 1 I (3» UacOSTTl- 

* oIMAsS*Ool (D *(RlYSlN4.RlZCs)- 

* b2MASS*(U0x (1 )*El 2(1) )#(R2YSN+R2ZCS), 
bjMASS*(D01 (1)*D13U)*EL3(1) > » (R3YSN+R3ZCS) - 
b4MASS*(DQl (1) *Dl4(n+£i.4(i) ) * (R4YS|\| + R4ZCS) 

C 

EM (3*2) =80DY0I (3*2) +BODY1I (2*2>*CST -BQDY1 I (2»3> tt SI2T 

* ♦BODY 1 1 (3»2)*C02T-B0DY1I(3*3)#C5T- 

* blMASS»DOl (2 ) »( r 1YSn+R1ZcS) « 

* b2MASS* (N2YSN*R2ZCS> # (001 (2) *EL2 YCS-e:L2ZSN) - 

* B3MASS*(R3YSN*R3ZCS)*(Oo 1 (2) *01 3YCS~6l 3ZSN*Ef3YCS-.EL3ZSN) - 

* b4rtASS*(R4YSN*R4ZCS)tt(001(2>*Dl4YcS-rH4ZSN»EL4YCS, E L4ZSN) 

C 

EM(3»3)-80DY0I (3»3) + BqDY1I (2,2)*S12T *BoDY1 I C2*3> *CST 

* +BOOYH (3»2)*C S T ♦ BOOYlI (3,3)*C02T ♦ 

* blMASS*Rl (1)*D01 U) ♦B1HASS*(R1YCS-K17SN)*001 (2) + 

* b2MA5S*R2 ( 1) * (001 ( 1) *EL2 ( 1) ) ♦ 

* B2MASS* (K2YCS-R2Z8N) MOOl (2 ) ♦EL2 YCS-fL2ZSN) ♦ 

* o3MASS*ft3U)*(00l U) *013(1) *EL3 < 1 > > ♦ 
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ft B3l4AS§»(R3YCS‘ a R3ZSN>o<D0J (2) ♦Ol3YCS®6l3ZSN*EL3YCS-EU3ZSN) * EMCAL 

® tt4MASS*RMl)ft<D0lU>ftDJ4(l)*EL<MD ><> EMCAl 

ft tf*MAsS« (R^YCS«R^SN) ft (OOi (2) ♦DlAyC$«01^ZSN*EL^YCS®EL & ZSN> EmCAl 

c. EMC&l 

EM (3 9 4) sBOOY 1 1 U * 2 > *S I NTT 1 *BOOY 1 1 < 1 9 3) *COSTT 1 * EWat 

* B JMAsS^OQX ( l ) ^ (BmOM^OOI <3) «R1 YSNaRiZcS) * E«t&L 

* BgMASSe(DOMl)oELg(i>) ft <BMOMOOOl(3)oR2YSMoR22cS)<- EMpAL 

*• B3MASS* (DOl U> ftD&3U)*EL3(l) }«'<BMOM<>601 (3) ^3Y$N-R3ZCS) • EMCAL 

* B*MASS* (DoHDoDl^tnoEU^CDJ^iBMOM^oOHSJ-R^YSN-RAZCS) EMCAl 

C EMCAL 

6M«39g)r Ca3MASS^3(3)o«°i3(3> o ei-3<2)*s3(2>«El„3t3))« EMCAl 

* 03MASS*'R3(l)<M<»S3(2}«£l.3(l)ftS3U)«£L3<2))>*SINTTlft EMCAl 

* («B3MASS0R3(2)ft(oS3(3)0EL3(2>*S3(2)eeL3(3) )ft , EMCAL 

* S3MASS^R3 ( 1 ) 45 (S3 ( 3) *EL3 ( 1 ) **S3 ( 1 ) *£L3 (3) ) ) *COSf T 1 EMCAL 

C EMCA'l 

EM(396) t :<84MASS^4<3>»<»S4(3)*EL^(2)os^<2)«EL^<3U<» *• EMCAj. 

* 84MASS^«4 ( J ) * {«S4 (2) «EL4 ( 1) ft s * ( i) «£U (2) ) ) *SINTtu EMCAL 

* (•e4MAsSOR4<2)® US4(3)*EL4<2)*S‘M2>oeU(3} >* EMCAL 

* t»4MASS^R^(i)«<S*(3)*Et-' !!, U)' > SAa)oEU4(3)))«C0STTl £M£Al 

EMCAL 

NOW SET UP THE LOWER HALF OP THE M MATRIX® EMCAL 

EMCAL 

define- SOME reoccurrin© terms emcal 

SR3 a B3MASS«(Dl3{2> * EL3(2>> EMpAL 

SR* t» B3MAS9* (0|3-O) * EL3(3)> EMpAL 

SR 5 a 84MASS»<D1^(2) ft £L4<2)) EMCAL 

SR6 s B4MA$$« (01^(3) * EL^(3)) EMCAl 

BRi*BODYH ( 1 92)-«B2MASSo£L 2 (2) «R2 < i ) a SR3*R3 < 1 ) «SR5«R4 ( \ ) EMCAL 

SRgsBODY 11 ( 1 * 3 ) «B 2 MASS<>SL 2 ( 3 ) *R 2 < l > a SR*«R3 ( i ) «>SR^R4 < i ) EMCAL 

EMCAl 

EM (A » i ) oBODY 11 U 9 1 ) < EL2 < 3 ) oR 2 ( 3 ) «Et2 ( 2) ®R2 ( 2 ) ) * EMCAf. 

ft SR4'«R3(3) «SR3ftR3<2) ftSR 6 *R*( 3 ) ♦SRSftRA{ 2 > EMCAL 

C . . EMCAL 

EM(A,2) B SRl-»C0STTi»SR2«SXNTTl EMCAl 

C‘ EMCAL 

EM(4»3)sSRiftSINTTl<!>SR2«C0STTl EMCAL 

C EMCAl 

c redefine §fu and $R 2 emcal 

SRlwSMOMft (001 L2) °COSTT iftOOl (3) ftSXNTTi) EMCAL 

SRgsBMOM* (oQOl ( 2> ftSINTTIoDO J ( 3 ) »COSTTi > EMCAl 

C . EMCAl 

EM<4*4) n 800Yl|<lel) EMCAl 

* ^egMASS^gLaojfttRgtajoSRg) * el 2(2>ft<R2<2) » sRjn * ewc*al 

* SR*ft(R3(3)<=SR2>ft§R3ft(R3<2MSPi>ftSR6ft(R4(3>®SR2) ♦SRS*'CRA<2>»SRi) EMCAL 

C EMCAl 

EM (^e 5) siSMASSft ( ( (R3 <3>«*§Rg)OEL3 (3) ft (r3 (2) -SRI >*£13 ( 2) ) #53 ( 1 ) o emcAl 
ft (R3(g)®SRi)6EL3(i)«S3(2)«*(R3(3)«SR2)4EL3n)ftS3(3)) EMCAl 

C . EMCAl 

EM (4*6) oS^MASSft < ( (R^<3 ) «SR2j <>EL^ (3 ) * < R< v (2-)-*SRl 5 *&L4 < 2) ) ©S4 (1 ) . EMCAl 

o (^'(2)oSRi)«EL4(i)<«S4(2)o(R4(3)oSR2)«ELA-a)«S4(3) ) EMCAl 

C _ EMCAl 

EM (§ 9 1 ) Gj«D3MAsSft£l 3 Q ) « (R3 (2) *§3 <2) »R3 (3) «s3 (3) ) EMCAl 

C* . , _ EMCAl 

EM (#9 g) ?B3MASS«'( l (ELS ( 3) *R3 (3) ftEL3 ( 1) »R3 ( D ) ftCO$TTl<> EMCAl 

ft El 3:(3) ftRSYSN) °S3 (2) «-(«EL3 ( 2 ) ftR3ZCS^TEL3 (2> «R3 (2) «£L3 ( 1 ) *33 (l»)o EMCAl 

* S JNTT l ) ftSj ( 3 ) ) eM eAi 

C - . . - - . EMCAl 

EM(5'9 3) sB3 M ASSft ( ( <EL3 (3) *R3 (3) oEL3 (X ) »r 3 (D ) ftSINTTi a gMCAl 

ft EL3 (3) ft^SYcS) 0 S 3 (2) ft (°£L3 (2 ) ftR3ZSNft (gL3 (2 ) ftR-3 (2> <>EL3 ( 1 ) **3 ( 1 ) } * EMCAl 
ft CQSTTl ) *53 ( 3) ) EMCAl 

0 _ EMCAl 

EM-(£4*rsB3MASS4gt.3 ( (.o«3 (2) *SRI ) *S3 (2) « (3-) *§^2^ (3) ) EMCAl 
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EMCAL 

EM (S t S) «B3MASS<> Ui*B3MA$S/ToT MAS) * ( < <EL3 (B) •♦02+EL.3 ( 1 ) **2) *53(2) - £M$Al 

♦ EL3(3>eEL3(2)#S3(3) > #83(2) ♦ ( <EL3(2> *»2*EL3 U>**2X>S3(3) - EMCAl 

• EL3(2)*EL3(3)*S3(a) )#S3(3) ) EMCAl 

EWCA& 

EM (S,6) «>(B3MASS*SAMASS/T0TMAS) * < <EU3 (3> *EUA (3> ♦EL3 U) *El* <1 >> * EMCAl 

# §4 (2) +EL3 (3) #EU4 (2) *S4<3) )*S3<2) ♦ (• <eU 3 (2) *EU4(2} ♦EUS ( i) *EL4 < 1) )«£f*CAi 

* S4t3)*EL3<2>#EL4(3>#S4(2n«S3<3)> EMCAl 

EMCAl 

EM (6 , i ) ,.84MASS»SUA ( 1 ) * <R4 (3) «S4 <2> *R4 <3> »S4 <3) > EmCAj. 

. EMCAl 

EM < 6 » 2 ) aB4MASS« ( ( ( EL4 { 3 > #R4 ( 3 ) +EL4 U ) #R4 i\ ) ) *C0STT \ *EU ( 3 ) *R4 YSN) «EMCAl 

* S4<2>*<*EL4<2)#R4ZC$.<Et4l2)#R4<2>*EL4<U<M4U>r*SXNm)*S4(3> ) EMCAl 

EMCAl 

EM(6*3)«84MASS4(((EU4(3> # «4(3)+EU4a}#R4U) )#SlNTTi-EL4(3) # R4YCS)*EMCAl 

* S4<2) ♦(-El 4(2}»R4ZSN« (EU4 (2) OR4 (2) +EL'4 U> *R4<1> ) »C0STT1 > »S4 (3) ) EMCAl 

EMCAl 

EM <6t 4) *84MASS#EU <t> <M i-R4 <2> ♦SRI) *84 <2> ♦ <-R4 (3t*$R2) *S4 <3) ) EMCAL 

EMCA|_ 

EM (6*S> a (83 M ASS»84MASS/T0TMAS) * < (• <£U <3> *E|.3 <3> +£[> < l) *£i.3 < I) ) * EMCAl 

♦ S3<2)«EL4<3)»EL3(2>*53<3> >*S4<2><-C*<EUM2>*EL3<2UEl><l>»EL3U))*EMCAt 

* S3(3)*EL4(2)*EL3<3)*S3<2) >*S4<3>> E«CAl 

EMCAl 
EMCAl 
EMCAl 
EMCAl 
EMCAl 
EMCAl 
EMCAl 
EMCAl 
EMCAl 
EMCAl 

# 


EM <6 9 6) s84 M ASS« a#«04MASS/ToTMAS> <* < ( (EL4 (3) »«2+Eb4 ( \ ) **2) *S4 (2) , 

* EL4 ( 3) «EU ( 2 > *S4 < 3 ) ) #S4 ( 2 ) ♦ M Et4 ( 2 > #*2*EL4 (1 J **2> *SM 3 ) - 

* Et4U)*EL4l3)^S4(2))*S4(3)) 

Da 10 Mb1«3 

DO 10 Nal *3 

EM(MsN) s»EM(M»N) * EEE'<M*W) 

continue 

RETORn 


# ’ 
end 
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SUBROUTINE F0MS(A98*N#E*TJ) 

DIMENSION AU> 90(1) *TJU) 

c FOMS 

c a ( i > contains the current time. i*e. au> * time, fo m§ 

C A (2) ThROUqh A(N) contain The INTEGRALS Where N EOUAUS the fOmS 

c NUMBER OF INTEGRALS PLUS I, FOMS 

g TO IS A SCRATCH ARRAY 0 Tj<U CONTAINS THE INITIAL .CELT AND Tj(2> £OMS 

c through tj<n> contain the back values of the derivatives* foms 

C 8(1) CONTAINS THE CURRENT OELT ANO 8(?) THROUGH b(N) CONTAIN THE FOMS 

c CURRENT DERIVATIVES* foms 

C -IF E e 0*9 REINITIALIZE THE DERIVATIVES* FOMS 

C IF E m 1*9. CONTINUE THE INTEGRATION* FOMS 

C . . Fqms 

C *#*#***#**#»*#»*#«<»###*<»**##*<»#«******#****#***#************•.»«*«****** 

c * 

c * 

c * 

C * ! fqm$ 

!F(n 0 le*> i) return foms 

IF IS oNEo Oa) ©0 To 20 FOMS 

E b u : foms 

DO 10 X*1»N ' FOMS 

Tu(j) o 8<t) foms 

10 CONTINUE FOMS 

20 H02 q 8(l)fi-0 o 5 FOMS 

oo 30 Ib2oN fOmS 

A(X) a A(I) * H02»<3otfBU>«TJ<I>) FOMS 

TJU) o ®(xi FOMS 

30 CONTINUE FOMS 

A(l> a All) o 0(1) FOMS 

RETURN FOM$ 

. . , FQ$$ 

« 

# 

#■ 

END 
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• * ft 4 ft ft * * * ft * ,*.4 ♦ * > ♦ 


SUBROUTINE ggrad 

ft 

ft 


♦ 

*ft#ft*ft***ftft#*ft#*ft*ftftftftft##ft##*ftft**ft#*ft*#*#ft*ft#**#*ft***#**#*******ft*##*ft* 


COMMON 

* 

ft 

ft 

ft 

ft 

COMMON 

ft 

ft 

ft 

ft 

COMMON 

ft 

ft 

ft 

ft 

ft 

COMMON 

ft 

■* 

ft 

ft 

« 

« 

COMMON 


COMMON 


ft 


common 

COMMON 

COMMON 


A<3> 

AF0UR(2> 

AI0(6»3»3) 


A0CJ{6»3*3> 
ATCPT2 (3»3) 
AX (3»3) 

BDMASS 
BODYDX (3*3) 
BOMASS 
8TWO(^> 

B3MASS 

CA(3) 

CGAINH2) 

' COSFEJ 


COSTT1 

C02T 

C ST 


DB'<3) 

delta? 

0Tl(3> 


OTIME 

01300T(3) 

0X3ZqS 

0XA00T(3> 

P14ZCS 

EEE <3i3) 

EL200T (3) 


EL2ZCS 
EL300T (3) 
EL3ZCS 


EL^OOT (3) 
EL4ZCS 
FAT (8) 

FEE (o) 

FF J (3) 
FLA03 
FO(3» 
F03(3> 

FPT (5) 

F12 (3) 

gainuo) 

G30OT 
H (3) 

HI (3) 

Hi (3) 

M3PRIMO) 

IB2F 

jCFC 

XD0F(6j 

igravf 

IPRINT 

NCAsE 

NGAIN 

omegAj 

PEN03L 

Q(4»4) 


AE<5> 

9 

AED<5> 

* qOMMc 

All ( 6 * 3 * 3 ) 

9 


COMMC 

AJ 1 (3) 

» 

AUT 

f COMMC 

AOU (3) 

f 

AONE (7) 

* COMMC 

ATHREE(S) 

9 

ATWO (4) 

9 COMMC 

A1J(2) 



COMMC 

BFOUR( ? ) 

* 

BMOM 

9 COMMC 

BOOYOl (3 j3) 

9 

800Y1 I (3*3) 

9 COMMC 

BONE <7) 

• 

BTHREE(5> 

* COMMC 

BXMASS 

B4MASS 

* 

82MASS 

9 COMMC 
COMMC 

CBO> 

» 

C9AIN0 (3) 

9 COMMC 
COMMC 

COSTTj 

9 

OOSTTO 

9 COMMC 

COSTT 3 

f 

C0STT4 

» COMMC 

CPI 

Cl 

t 

cpe 

9 COMMC 
COMMC 

DD01<3) 

* 


COMMC 

001(3) 

* 

OOiDOT (3) 

9 COMMC 
COMMC 

012(3) 

* 

013(3) 

9 COMMC 

013yCs 

9 

0X3YSN 

9 COMMC 

D13ZSn 

* 

0X4(3) 

9 COMMC 

DX4YCS 

9 

0X4YSN 

9 COMMC 

014ZSN 



COMMC 

EEJ (3»3) 

9 

EL2 (3) 

9 COMMC 

EU2YCS 

9 

E12YSN 

9 COMMC 

EL2ZSN 

9 

EL?(3) 

9 COMMC 

EU3YCS 

9 

EL3YSN 

9 COMMC 

EL3ZSN 

9 

EL4(3) 

9 COMMC 

EU4YCS 

9 

eiaysn 

9 COMMC 

elazSn 

9 

EM (696) . 

COMMC 

FEED ( 6 j 



COMMC 

9 

FFF (3) 

9 COMMC 

FLAGl 


FLA02 

f COMMC 

FLAG4 

» 

FNi 

* COMMC 

FOX (3) 

• 

F02(3) 

9 COMMC 

FI (3) 
F13(3) 

9 

FI X (3) 

t COMMC 
COMMC 
COMMC 

G3 

<3 


COMMC 

G4 

9 

GAOOT 

COMMC; 

HCM0(3) 

9 

HOOT (3) 

9 commc; 

-HOO) 

9 

H*< 6 ) 

9 COMMC 

HXPD0Ti3j 

H4PRIMO) 

9 

HXPRIM (3) 

9 COMMC' 
COMMC 

iCFA 

9 

JCF 8 

9 COMMC 

ICFO 

9 

I Dock 

9 COMMC' 
COMMC 

fPNDUM 

IPROPF 

9 

: tPNTCK 

* COMMC 
COMMC 

NCHECk 

numcmg 

9 

NOECK 

9 COMMC 
COMMC 

OMEGA 3 

PEN04U 

* 

9 

0MEGA4 

COMMC 

COMMC. 

COMMC 



no a n no n 


COMMON 

R 

» 

R013* 9 

R113) 

9 eoMfsc 

ft 

RJOOT13) 

9 

RiYQS 9 

RJYSN 

9 £0«MC 

* 

RJZCS 

9 

RIZSN 9 

R213) 

9 eowMc 

ft 

Rsoo^O) 

9 

«2YCS 9 

RgYSw 

9 COMMC 

* 

R2ZCS 

9 

R2ZSN 9 

R313) 

9 co^c 

ft 

R3D0TO) 

9 

R3YCS » 

R3YSN 

9 e©*®c 

ft 

R 3 ZCS 

9 

R3ZSN , 

R^(3> 

9 COmkc 

ft 

RAD0T<3> 

0 

RGYCS 9 

R4-YSN 

9 COMMC 

ft 

R4ZCS 

9 

R<>Z$N 


COMMC 

COMMON 

s 

9 

SOOT 9 

SXNFEJ 

« COMMC 

ft 

S*NTT*J 

9 

SZNTTo 9 

SINTTi 

e COMMC 

ft 

§INTT2 

9 

SINTT 3 9 

sintta 

9 gOMMC 

« 

$P 

9 

SUM1 9 
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9 COMMf 

© 

TemP12(3»3) 

9 

TEMPl3{3t3) 9 

T£MPj4 (3?3) 

9 eOMMf 

© 

TEMPIS (3» 3) 

9 

TERMl ( 3 ) 9 

TERM2 (3) 

0 COMMC 

© 

TFRjCT 

9 

TMATA(6) , 

THATA0(6) 

9 COMMf 

© 

THETAl 

9 

THETA 3 9 

THETA4 

0 COMMC 

© 

ThETO 

9 

T 180(3,3) 9 

T I80J (393) 

0 COMMf 

«• 

TIME 

9 

TJ » 

TJ1 (10) 

« COMMf 

♦ 

TJ2 (10) 

9 

TJ3U0) , 

TJ*<10> 

9 COMMf 

© 

TmoTo r 

9 



COMMf 

© 

TOEF (|) 

9 

TOTMAS , 

TO! ^ 

9 COMMf 

•©■ 

TOO® (3) 

0 

TQOP (3) 9 

TQ1G<3> 

1 COMMf 

©• 

TQlP(3) 

9 

TSTaRT , 

TSToP 

9 COMMf 

«►- 

ttidot 

9 

TT300T 9 

TT400T 

9 COMMC 

© 

T1EF( 3 ) 

9 

T13 9 

TlA 

COMMf 

COMMON 

V(3) 




COMMf 

common 

WOO) 

9 

WS 9 

WK3) 

9 epMMf 

•© 

W3(3) 

9 

W*(3) 


COMM! 

COMMON 

X(6,T) 

9 

XC 9 

XCDOT 

9 COMM! 

« 

XMU 




COMM! 


, . . . com 


* 

© , - 

o©©©©©©«©©«©©©©©©©©©©©©©©©©©©©©.©©*©©©*©©©«©©#*»©*©©*©*©©**©9©»©*©©«©©©. 


pSon 

SlNTTl a SSN(THETAl) PCON 

COSTTi 3 . COS<Th£TaW PCOn 

DO 30 MaJ*3 PCON 

FS s CSaINO(M>»«0(M) PCON 

FPT(M> a: f?CON 

T q 0?(M) 9 pSt»AOJ(M) PC ON 

30 CONTINUE PCON 

FSv*. 0* PCON 

IF (COSTTJ e GT 0 0:«87)FS ■- CGAlNi ©WO (2) PCON 

IF (COSTTI „LT 0 0.87>FS ® • - CGA1N1 <2> # »(M2> PCON 

IF (SlNTTl 0 GT 8 0 e 8?)FS a CGAIN* (2) *WO <3) PCON 

IF (SlNTTl »L,T e , “• 0*S7)FS a • C©AXNi <2> ©WO ( 3) PCON 

FPT (4) a 2v©AB5(FS) PCON 

TOlP-(g) 9 FS^AlJtg) PCON 

FS -s- C6AXNl(l)P-(0ME0Ai *<■ SP) PCON 

FPT(S) a 2 tf «ABS(FS) PCOn 

TQtPM) « FS«AiJ<l) PCON 
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o o ooo 


RETURN PCON 

PCON 

#■ 

# 

END 
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$ $ $ & $ $ ft. ft ft ft ft ft 4 .$ S $ . ft ft ft ft . ft ft ft ft 


c 

c 

c 

c 


SUBROUTINE recalc 

« 

« 


common * - - - — - - 




COMMON 


COMMON 


Common 


COMMON 


COMMON 


< 

o 

ft 


COMMON 

J 

COMMON 


ft 

o- 

■ft- 

ft 

< 

ft 


COMMON 

■COMMON 

COMMON 


• A$3) 
APOUR(g> 

A10 (6p 3«3) 
AOCJ t6?3o3) 
AyCpTS (3?3) 
Al<3 0 3> 
BDMASS 
SoDVOI < 3 ft 3) 
BOmaSS 
BTW0(4) 
B3MASS 
CA (3) 

CGAXNX (2) 

COSFEU 

CoSTTl 

C 02 T 

CST 

DB (3) 

OELTa^ 

DTI(3> 

07IME 

D1300T{3> 

D132CS 

Dl400T-(3) 

ohzc s - 

EEE (3®3) 
EL200T(3) 
EL2ZC§ 
EL3D0T (3) 
EL3ZCS 
EL4D0? (3) 
ELA 2 CS 
FAT ( 8 ) 

FEE (&) 

FF-J (3) 

FLAGS ' 

FQ<3> 

F03(3> 

FPT(S) 

F12(3) 

QAlN(iO) 

G3D0? 

H <3> 

HI <35 
■HI (3) 
H3PR1MJ3) 
I02F 
ICFC 


XGRAVFi 

XPRINT 

NCA§£ 

NGAxn 

omegaj 

PEND3L 

Q ( 4 s 4 ) 


9 

9 

9 

9 

9 

9 

9 

« 

9 

9 

9 

9 

9 

9 

9 

9 

9 

9 


AE{ 5 > 
AIX( 6 o393) 
AUX < 3 } 

AOj ( 3 ) 
ATHSEE(5) 

Al J( 2 ) 
BF0UR<2) 
BODYOj (3«3) 
B0NE(7) 

81 MASS 

b4mas$ 

C8(3) 

COSTTj 

COSTT 3 

CPI 

Cl 

0DoU3) 

001(3) 

012(3) 

013YCS 

013ZSN 

Dl^YCs 

d 142 s n 

EEJ(3 s3 ) 

EU2YCS 

EL2Z§N 

EU3YCS 

EL-32 SN 

EL4YCS 

Elazsn 

FEED ($) 


F01 (3) 
Fl(3) 

F13(3) 

-63- 

64 

HCMG ( 3 ) 
MOO) 
HXPDOT O) 
H4PRIMO) 


XCFD 

3PN0LM 


NCHECK 

NUhCMG 

0ME3A3 

pencil 


AED ( 5 ) 

auT 

A ONE ( 7 ) 
ATWO(^) 

BMOM 

BODY!! ( 3 ? 3 ) 
BThReE (5) 
82 MASS 

CGAfNOO) 

COSTTO 

cosm 

CPg 


9 OOIDOTO) 

9 013 (3) 

9 013YSN 

9 014(3) 

9 DX 4 YSN 

9 EL2(3) 

9 EL2YSN 

9 ELS (3) 

9 EL 3 YSN 

9 EL 4 { 3 ) 

9 EL 4 YSN 

9 EMi(& 9 6 ) 

9 FFF < 3 ) 

9 FLA 62 

9 FNi 

9 F 02 ( 3 ) 

9 Fl 1 (3) 


9 G&DOT 

9 HOOT (3) 

9 H8'(6) 

9 HlRPfM (3) 

9 fCFB 

9 I DOCK 

9 XPNTCK 

e NOECK 

9 ' OME0A4 


COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

eOMMf. 

COmNC 

COMMC 

£QMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

0OMMr 

POMMC 

COMMf 


QOMMC 

COMMf 

COMMf 

COMMf 

eoMNf 

COMMC 

COMMC 

CQMMC 

COMMf 

COMMf 

COMMf 

COMMf 

COMMf 

COMMf 

COMMf 

COMM< 

•COMMf 
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c 

c 

c 


c- 

c 


common 

R ’ 

» 

R0(3> * 

Rl<3) 

# 

RiooTta) 

* 

R1YCS , 

R1Y3N 

« 

R1ZCS 

* 

' RlZSN * 

R2K3) 


«2D0T(3) 

t 

R2YC* * 

«2YS N 

# 

R2ZCS 

* 

R2ZSN , 

R3 (3) 

* 

RSDQTO) 

* 

R3YC5 * 

R3YSN 


R3ZCS 

t 

R3ZSN , 

R*(3) 

# 

R4D0T<3> 

* 

R4YCS * 

R4YSN 

# 

COMMON 

razcs 

s 

* 

* 

razsn 

SOOT » 

SINFEJ 

* 

SINTTJ 

* 

SINTTO * 

SINTTl 

* 

SinTT2 

* 

SlNTTa f 

SINTT 4 

• 

SP 

* 

SUM1 » 

SUM2 

» 

SUM3 

1 

S2 (3) * 

S3 (3) 

« 

COMMON' 

S 4 O) 

T (3*3) 

* 

TC (3*3) * 

TEMPI (3) 

# 

#• 

TEMPS (3) 

Temps 13 ) 

* 

t 

TEMP4(3) , 

TEMP5(3»3) 

* 

TEMP6 13*3) 

♦ 

TEMPT (3*3) * 

TEMP8<3*3> 

* 

TEMP9<3*3> 

9 

TEmP10(3«3) 9 

TEMPll (3*3) 


TeMP12{3*3) 

» 

TEMP13 (3»3) , 

- TEMP14(3,3) 


TEMP15(3*3) 

* 

TERMIO) , 

tERM2<3) 

#• 

TFRJCT 

* 

THATA(6) , , 

THATAD (6) 

# 

thetai 

* 

THET*3 , 

THETA4 

# •- 

Theto 

* 

TIB0(3,3) * 

TlBOI (3*3) 

#' 

TIME 

* 

TJ * 

TJK10) 

# 

TJ2 ( 10) 

» 

TJ3(10) , 

TjA(lO) 

# 

# 

TMOTOR 
TOEF (3) 

* 

9 

TOTMAS * 

TO-l 

<* 

TQ0G(3) 

9 

T.Q0PO) * 

T9>10(3) 

« 

TQJ,P (3) 

9 

tstaht , 

TSToP 

# 

TT100T 

9 

TT300T , 

TT4D0T 

# 

T1EF (3) 

9 

. T13 * 

T1A 

'common 

COMMON 

V(3> 

WOO) 

9 

WS * 

Wl (3) 

# 

COMMON 

W3 (3) 
X(6 5 T) 

9 

9 

WA(3) 

xc 

XCOOT 


COMMC | 
£OMMC 
COMHf 
CO MMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC .1 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC ' 
COMMC , 
COMMC 
COMMC 
COMMC ! 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
QOMMC 
COMMC 
COMMC 
COMMC 
COMMC 

. . . , . COMMC 

# I 




SINTTl 3 SiN(THETAl) 

COSTTj, *, COS(ThETaX) 

CALL SCALC 

ELS ( 1 ) a DJ2(U ♦ SPS2<1) 
EL2Y2) a 012(2) ♦ $*$2U) 
EL2,(3) a Dj 2 (3) S*S2(3) 

SINTT3 a S2 N(THETa3) 

C0STT3 a- C0S(THlTA3) 

EL3<1> s PEND3!,*$INTT3. 

EL3<2) a •PEND3L*C0STT3^S3(3) 
EL3<3> a PEN03L*C0STY3*S3<2> 
S1NTT4 a SlN(THETAA) 

C0STT4 a. CqS<THETA4> 

-EL<M 1 > a pEND4fc»SlNm 
EL 4(2) a «PEND4L*C0 ST T4* S 4(3) 
£L4(3) 3 : PEND4L*CQSTT4-*S4<2) 
RU-1) a (S 0 MASS/T 0 TMAs)«D 01 (i) 


RECAj. 

RECAl, 

RECAli 

recal! 

RECAi 

«ECALi 

RECALi 

RECAl' 

RECAil 

reca l 

RecaL 

RECAL 

RECAl 

RECAl 

RECAL 

RECAl 

RECAl 

RECAl 


r>_ A/± 



o o o o o 


ft 

ft 

ft 

ft 

ft 

ft 

ft 

ft 


«> (BgMASS/ToTMAS) *EL2 ( l ) - <83 MaS$/T0TMAS>*1013<1> ♦ 

- • > FL4/U 1 

* D0U3)* s InTT1) 


m (84MAsI/ToTMAS) * (014 ( 1 ) ♦ EC^(D) 
r H 2) a iB0MA s 5/ T 0TMAS)#(D 0 l(2><»C0STr{ 

• (B2MAS5/T0TMAS) °EL2 ^2) 

-(B3mASS/ToTMAs)»(013<2) ♦ EU3(2)) 
«.(84MASS/T0TmaS)»(OX4(2) * EU<2>> 

R1 (3) a (B0MASS/T0TMAS>*(«D0l(2>*$XNTTl * D01(3> & C0STT1) 
- ( B2MAS5/TOTMAS > *EL2 (3) 

- (B3MASS/t0TMAs) *(D13(3) 

•(BAMASS/t0TMAS)*(0l4(3) 


EL3(3)) 
EU(3> ) 


R2(l> 
R2(2> 
R2(3) 
R3<1> 
R3(g) 
«3(3) 
RMl) 
R*(2> 
R4(3) 
return 


9 


R 1 ( 1 ) 
R1 (2) 
Rl(3) 
Rl(l) 
Rl(2) 
<3) 
Rl(l> 
Rl(2> 
*1(3) 


EL2U) 
El 2<2) 
EL2(3) 
0l3(l> 
013(2) 
013(3) 
014(1) 
0l4 (2) 
014(3) 


EL3 ( 1 ) 
EL3(2) 
Et3(3) 
EL4(1) 
EL* (2) 
EL4 (3) 


EL3 ( 1 ) ) RECAt 
RECAL 
*ECAt 
RECAL 
RECAt 
«£CAL 
RECAL 
RECAL 
RECAj. 
RECAL 
RECAL 
RECAj. 
RECAL 
recal 

RECAL 
RECAt 
RECAL 
RECAl 
RECA t 
RECAL 
RECAt 


ftftftftftft*ftftftftft#ftftft#ft«ftftft*ftftftftftftftftftftftftftftft*ftftft*ftftft****ftft** ft ft** <> ******* <i ' & **' a 

ft 


*■ 


« 

END 
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oooo 


subroutine SCALC 
# 

« 


* 


o####oo^##ooooo#oooo##*»#o*oooottO«ooooo###o#*#« 


COMMON 

A (3) 

9 

A&<5) t 

AED (5) 

# 

AFOUR (2) 

» 

Aj 1 (^9393) , 

A LIT 

• 

AIO(6»3*3) 

9 

AJl (3) * 

# 

AOCJ (6* 3e3) 

f 

AOJ (3) 9 

AONE(T) 


ATCpT2(3t3> 

9 

ATHREE(S) , 

ATW0( 4 ) 

# 

A1 <3t 3) 

9 

Al J (2) 


COMMON 

BDMASS 

t 

BFOUR<2) , 

BMOM 

# 

# 

BOOYDI (3*3) 
bomaSS 

9 

BODYOK393) 9 
B0NE.<7) 9 

BODYl I (39 
B'HReE(5) 

<9 

BTW0(4> 

9 

81MASS 9 

B2MASS 

« 

B3MASS 

9 

B4MASS 


COMMON 

CA(3) 

9 

CB (3) 9 

C3AIN0(3> 

# 

CGAINK2) 

9 

costtj 9 


#■ 

COSFEJ 

9 

COSTTO 

<9 

COSTT1 

9 

C0STT3 9 

C0STT4 

» 

COZT 

* 

CPI . 9 

CP2 

0 

CST 

9 

Cl 


common 

D8 (3) 

9 

DOOl (3) 9 

OO-IOOT (3) 

99 

DELTaT 

9 

D01(3> , 

99 

0TI<3) 

9 



»■ 

DTIME, 

9 

012(3) 9 

013(3) 

« 

D13D0T <3> 

9 

DX3YCS , 

D13YSN 

« 

D13ZCS 

9 

013ZSN . 9 

D14<3) 

* 

D1400T(3) 

9 

D 1 AyCs 9 

OlAysN 

4‘ 

D14ZC§ 

9 

OHZSn 


COMMON 

EEE (3*3) 

9 

££J<393> 9 

EL2(3> 

99 , 

EL2D0T(3) 

9 

ELSYCs » 

EL2YSN 

* 

EL2ZCS 

9 

EL2ZSn , 

EUS.(3) 

99 

EL300T<3) 

9 

■ EU3YCS 9 

EU3YSN 

99 

EL3ZCS 

9 

EU3ZSN 9 

EL& (3) 

•» 

EUD0T(3) 

9 

euycs 9 

EL4YSN 

99 

el^zcs 

9 

EU^ZSN 9 

EMi(696) 

COMMON 

FAt(S) 

» 



99 

FEE (6) 

9 

FEE0<6> 9 

FFF (3) 

99 

FFJ (3) 

9 

FtAGl 9 

FLAG2 

« 

FL.A03 


FUAG4 , 

FNI ’ 

99 

FO(3) 

9 

F01 (3) 9 

FOE (3) 

99 

F03 (3) 

9 

FI (3) 9 

Fll (3> 

99- 

FPT(5) 


F13(3> 


99 

F12<3) 

9 


COMMON 

GAIN ( lO) 

9 

G3 9 


o 

G3DOT 

9 

64' 9 

G400T 

common 

H <3) 

9 

HCMG(3) 9 

HD0T(3) 

0- 

HI (3) 

9 

HO (3» 9 

HW(6) 

99 

Hl(3> 

9 

H1PD0T(3) f 

HlPRlMO) 

99- 

H3PRIM (3) 

» 

H4PRlM{3) 


common 

XB2F 

9 

icfa , 

JCFB' 

99 

ICFC- 

9 

ICFO e 

100CK 

99 - 

ioof;(6> 

9 



•99-. 

igravf- 

9 

IPNOUM 9 

IPNTCK 

99 - 

iprint 

9 

IPROPF 

common 

ncase 

9 

NCHECk 9 

NDECK 

99 - 

NGAJN- ■ 


numcmg 


common 

omegax 

9 

OMEGA 3 9 

’0MEGA4 

common 

PEN03L 

9 

PENCIL 


COMMON' 

Q(4»4) 


- 



***#*♦< 

* COMMC 
COMMC 

t COMMC 

* COMMC 
9 COMMC 

COMMC 

* COMMC 

* COMMC 
i COMMC 
» COMMC 

COMMC 
t COMMC 
COMMC 
t COMMC 
9 COMMC 
t COMMC 
COMMC 
COMMC 
9 COMMC 
COMMC 
» COMMC 
t COMMC 
9 COMMC 
9 COMMC 
COMMC 
» COMMC 

* commit 

* COMMC 
» COMMC 
9 COMMC 

* COMMC 
COMMC 
COMMC 

t COMMC 

* COMMC 
9 COMMC 

* COMMC 
9 COMMC 

COMMC 
COMMC 
COMMC 
COMMC 
9 COMMC 
9 COMMC 
9 COMMC 
COMMC 
9 COMMC 
e COMMC 
COMMC 
9 COMMC 
COMMC 
9 COMMC 
COMMC 
COMMC 
COMMC 
COMMC 
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noo oooooooo 


C 


common 

R 

9 

RO<3> 

0 

RU3) 

9 gOMMC 

0 

R10QT<3) 

9 

Rl.YCS 

9 

RIYSN 

9 COMMC 

» 

R1ZCS 

* 

R1ZSN 

9 

R2C3) 

e COMMC 

0 

REDO? (3) 

9 

RgYcS 

9 

Rgys N 

« COMMC 

« 

R2ZCS 

9 

R2ZSN 

9 

R3<3> 

9 COMMC 

0 

r30qT O) 

9 

R3YCS 

9 

R3YSN 

9 COMMC 

0 

R3ZCS 

9 

R3ZSN 

9 

r4(3) 

9 COMWC 

0 

Radons) 

9 

R^YqS 

0 

r$v§n 

9 eom-ic 

0 

RAZCS 

9 

R4ZSN 



COMMC 

COMMON 

S 

9 

SOOT 

0 

SINFEJ 

® COMMC 

0 

SINTTU 

9 

SINTTO 

9 

SINTTl 

o COMMC 

0 

SjNTTa 

9 

SINTT3 

9 

SJNYT4 

9 COMMC 

0 

SP 

* 

SUMI 

9 

SUMS 

9 COMMC 

0 

/ 

SUM3 

9 

S2 (3) 

9 

S3 ( 3) 

9 COMMC 

0 

S4(3) 





COMMC 

COMMON 

T (3s3> 

9 

TC(3»35 

9 

TEMPI (3> 

9 0OMMC 

0 

TEMP2 (3) 

9 




COMMC 

0 

temps <3) 

* 

TEMP4(3) 

9 

Temps (393) 

9 COMMC 

«£• 

TEMP6<3»3) 

* 

TEMP? (393) 

9 

TEMPS (3*3) 

9 COMMC 

0 

TEMP9<3p3> 

9 

T£MPiO{3*3) 

9 

TEMPXl (3e3) 

9 COMMC 

0 

T EMP 12(393)' 

9 

TEMP13{3 9 3) 

9 

TEMP14<3«>3> 

9 CpMMC 

0- 

TEMP1S (3*3) 

9 

TERM1 (3) 

9 

TERM2(3) 

9 £OMMf 

0 

tfrsct 

9 

TMATA(6) 

9 

THATAO(O) 

9 COMP4C 

0 

THETAi 

9 

THETA3 

9 

THETA4 

9 eOMMC 

0 

theto 

t 

T|B0(3 9 3> 

9 

TI80K3«3) 

9 COMMC 

0 

time 

9 

TJ 

9 

TJHIO) 

9 COMMC 

0 

TJ2U0) 

9 

TU3U0) 

9 

TJA(iO) 

9 OOMMC 

0 

' 

tmoToR 

9 




COMMC 

0 

TOEF (3) 

9 

TOTMAS 

0 

m 

9 pOMMt 

0 

TQ0Q.(3) 

9 

TQ0P13) 

9 

T01©(3) 

9 COMMC 

0 

TQ1PT3) 

9 

TST A RT 

9 

TSTqP 

9 com< 

0- 

TTIOOT 

9 

TT300T 

9 

TT^OOT 

9 gOMM( 

0 

T1EF(3) 

9 

T13 

9 

Tl^ 

COMM< 

COMMON 

V <3) 






common 

WO(3> 

9 

ws 

9 

Wl <3) 

9 £0MM< 

0 

W3 ( 3) 

9 

«A(3) 



COMM< 

COMMON 

X(6?T) 

9 

xc 

9 

XCOOT 

9 COMM* 

0 

XMU 





COMMi 







COMMt 


0000000««0,&0<HJ.000.{>00000.000<*‘.jH}.»*j*0«#04Hj,{j.G00.»000{H>0««0&00&0000«0.&#0«.8„j>a,» < 

0 


00000000000000*0$00000&000tt»«00^«<j.O0* < }4*&00«*0000000C>*0«000.0000{}0*te.C>.5.» 

this subroutine calculates the elevator position* 


S ev O o 

RETURN 


SCAL 

SCAL 

SCAL 

SCAL 

$CAL 


, , .... ... S£AL 

000000*000&®0*#«0*000.fr000<H>0«000000004J00&0«»e0#<}<}0<j>.&{i0400-&0<5-SJ{J«0«eK><s©t> 


0 

0 


END 
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c 

c 

c 

c 


subroutine 

# 

4 

4 


SQCAUC 


*>#*»*#«•*»•»»*»•«#<>*•««*#•***»**•*•••#«••••««< 


COMMON A (3) « 

* AF0UR(2) » 

AIO (6t3*3) * 

* A0CJ(6'3f 3) i 

* ATCpT2 (3t3) . 

* Al(3f3> , 

COMMON BDMASS 9 

* BoDyOI < 3#3) » 

* BOMASS , 

*• BTW0(4) * 

* B3MASS » 

COMMON CA (3) » 

* CGAJNK2) » 

* COSFEJ t 

* COSTTJ 9 

* C02T t 

■* CST » 

COMMON OB (3) * 

DELTAT * 

0TIC3) t 

OTIME ♦ 

D13DOT (3) 9 

DI3ZCS. , 

0VA00>T(3) t 

OI^-ZCS: 9 

COMMON EEE<3»3> » 

EL2D0T (3) ♦ 

EL2ZCS 9 

EU3D0T(3) » 

EU3ZCS s 

El,4D0T<3) 9 

ELAZCS 9 

COMMON FAT (Q) 9 

FEE <6) , 

FFJ<3) » 

FCA03 9 

FO<3) 9 

F03(3) * 

FPT(Bi , 

F12(3) • 

COMMON GAIN< 10) » 

> G3DO?’ » 

COMMON H ( 3) . > 

HI(3> 9 

HlO). » 

H3PRIM.<3) 9 

COMMON JB2F< 9 

ICFC' 9 

XDOF1*) 9 

i GRAVE- « 

XPRINT * 

COMMON NCA$£ 9 

* ngaxn , 

common omesai » 

COMMON PEN03U 9 

COMMON (3(494) 


# 

« 

« 

<* 

4 

4 

4 

( 

*■ 

4 - 

4 

4 

# 

4 

< 

4 

4 

4 

4 - 

4 

4 

4 


« 

4 

4 

< 

4 

4 

■ 4 - 

4 


AEi(B) 

AU <6,3,3> 
AJl (3) 

AOJ (3) 
ATHREE (5) 

Al J (2) 
8F0UR(p) 
BODYOI (3|3) 
BONE (7) 
BIMASS 
B4 M ASS 
CB (3) 

COSTTj 

COSTT3 

CPI 

Cl 

'0001*3) 

D01 (3) 

012(3) 

DUYCs 

013ZSm 

OHYCS 

014ZSN 

E£U (3j3> 

EL2YCS 

EL2ZSN 

EU3YCS 

EL3ZSN 

EUYCs. 

elaZSn 

FEED (6) 
Fi,AGl 
FLAG4 
FOl (3) 

FI (3) 

F13 (3) 

G3. 

G4' 

HCMQ(3) 

H0<3) 

HlPOOT (3) 
H4 P«Xm<3) 
ICFA 
ICFD 

IPNOLM 

IPROPF 

NCHECk 

numcmg 

OMEGA 3 . 

PEN04U 


AEO (5) 

f 

COMMC 

50 MMC 

AU^ 

9 

COMMC 

A0NE(7) 

9 

COMMC 

ATW0(4) 

9 

COMMC 

COMMC 

smom 

♦ 

COMMC 

BOOyiI (3#3) 

‘ t 

COMMC 

b three <5) 

9 

COMMC 

B2MASS 

9 

COMMC 



COMMC 

CGAinO<3> 

9 

COMMC 

COMMC 

COSTTO 

9 

COMMC 

C0STT4 

9 

COMMC 

cpe 

9 

COMMC 

COMMC 

001DOT(3) 


COMMC 

9 

COMMC 



COMMC 

013(3) 

9 

COMMC 

D13YSN 

9 

COMMC 

014(3) 

9 

COMM< 

014YSN 

9 

COMMc 

COMMl 

EL2<3) 

* 

COMMi 

EU2YSN 

9 

COMMi 

£1,3 (3) 

* 

COMMi 

EU3YSN 

9 

COMMl 

EL4(3) 

9 

COMM 

EU4YSN 

9 

COMM 

EMi(6,6) 


COMM 



COMM 

FFF (3) 

9 

COMM 

FLAG2 

9 

COMM 

FNt 

9 

COMM 

F0g:(3> 

9 

COMM 

FIX (3) 

9 

COMM 

G4D0T 


C°MM 

COMM 

COMM 


COMM 

HDOT (3) 

9 

COMM 

HW ! (6) 

9 

COMM 

H1PRIM(3) 

9 

COMM 



COMM 

|CFB 

9 

COMM 

IDOCK 

9 

COMM 



COMM 

IPNTCK 

* 

COMM 



COMM 

noeck 

9 

COMM 

Comm 

0MEGA4 


comm 

COMM 

COMM 
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001)0 0 0 0*0 000 O ' 


common 

R 

9 

R0<3) 9 

Rl<3) 

9 COMMC 

» 

RIDOT (3) 

# 

R1YCS , 

R1YSN 

* COMMC 

« 

R1ZCS 

9 

RlZSN 9 

R2:(3) 

9 COMMC, 

* 

RZDOT (3) 

9 

R2YCS , 

R2YSn 

* COMMC 

4 

R2ZCS 

9 

R2ZSN , 

R3( 3) 

* C0M5K 

© 

R3DqT(3) 

9 

R3YCS 9 

R3YSN 

* COMMC 

♦ 

R3ZCS 

9 

R3ZSN , 

RA<3) 

9 gOMMC 

© 

RAD0T<3> 

9 

RAYCS * 

R4YSN 

* COMMC 

4 

R4ZCS 

9 

RAZSN 


COMMC 

common 

S 

9 

S0OT f 

SINFEJ 

9 COMMC 

» 

SINTTU 

9 

SINTTo 9 

SINTTI 

9 COMMC 

* 

SlNTTg. 

9 

SXNTT 3 , 

sintta 

9 COMMC 


SP 

9 

SUMl 9 

SUM2" 

9 COMMC 

# 

SUM3 

9 

S2<3) ♦ 

$30) 

9 COMMC 

4 

S4(3) 




COMMC 

COMMON 

T (3*3) 

♦ 

TC 0*3) » 

TEMPlO) , 

» COMMC 

© 

TEMPI 43) 

9 

TEMP4(3) , 

TEMP5<3*3> 

COMMC 

#■ 

temps (3) 

9 

9 COMMC 

© ' 

TEMPO 13*3) 

9 

TEMP7 <3*3) * 

TEMP8<3?3) 

9 COMMC 

■© 

TEMP$t3*3) 

9 

TEMPlO (3*3) # 

TEMPI 1(393) 

9 COMMC 

© 

TemPJ£<3®3) 

9 

TEMPi3{3*3) f 

TEMPIA(3*3) 

9 COMMC 

4 

TEMPlS (3?3) 

9 

TERMIO) . 

TERM 2 O) 

9 COMMC 

©- 

TFRjCT 

THETA1 

9 

9 

THATA{ 6 ) , 

THETA3 , 

THATAD( 6 ) 

THEtAA 

9 COMMC 
9 COMMC 

« 

TheTo 

9 

TX80(3,3) * 

TlBOI 0*3) 

* COMMC 

© 

TIME 

9 

TJ * 

TJK10) 

9 COMMC 

© 

TJ 2 ( 10 ) 

9 

TJ3U0) * 

TUA(iO) 

9 COMMC 

« 

TMOTOR 

9 



COMMC 


TOEF'O) 

9 

TOTMAS 9 

T 01 

* COMMC 

© 

TQ0Q43) 

9 

TQOPO) t 

TQ‘10(3) 

» COMMC 

© 

TQIPO) 

9 

TSTART , 

TSTbp 

* COMMC 

© 

TTXOOT 

9 

TT3D0T 9 

TT400T 

9 COMMC 

©- 

T1EF (3) 

9 

TX3 * 

Tl* 

COMMC 

COMMON . 

V (3) 




COMMC 

common 

WOO) 

9 

WS 9 

W 1 (3) 

9 COMMC 

© 

W3 (3) 

9 

W4<3) 


COMMC 

common 

X(6gT) 

9 

xc » 

XCOOT 

e COMMC 

© 

XmU 




COMMC 


. COWC 

©ft©©©©©©©©**©©©®©©©©©©©©©©#©©©©*©©©©©#***©©©©©©©©©©* »**©•&©*©©«***©©©©©« 
■» 


©* 


©®®*©©©#©©©*©©®©4©©«*®*©©©«*«©®©©®©©©©©©»®©©©©©©©©©©©» ©©©»*©©»*•»»©©»©«« 

SOCAi, 

THIS SUBROUTINE CALCULATES THE ELEVATqR VELOCltYe SDCAl 

SQ'CAL 

•SW o 08 * SDCAl 

KgTURN SQQA L 


..... . SDCAL 
©©#©##©©©*«©©©©©©©©©©©&©©©©©©©©©«*©♦©©©©***©©***©©»«©©«*©*©«©©©©»«*©©©« 
© 

©- 


End- 
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SUBROUTINE 3YEQNS ( A*N*NR»NC»FLAG) 


TT 

a###*###*###*###*###*########*######*##########**##*######******#***#** 

* srw 

LINEAR SIMULTANEOUS EQUATIONS SYEQt* 

A AUGMENTED matrix (AC) WHERE AX * C SYEQf* 

ORIGINAL DATA OESTROYEO $YEP» 

N NUMBER OF EQUATIONS SYEf^ 

SOLUTION X WILL BE COLUMN N*l OF MATRIX. A SYEQh 

FLAG « 0, SOLUTION EXIST F* 1,0 NO SOlUTiOn SYE<^ 

DIMENSION A(NRiNC) SYEOf* 

Nl » N SYEQh 

N2 a NU1 SYE<h 

NO » Nl -l SYEQis 

FLAG a 0t SYEQf'i 

DO 60 I «i*Nl S^EGf* 

M * 1 SYEQK 

MI a M SYEQft 

IF (MI -nD 2*12 9 2 SYEQi^ 

DO 10 II aM»N0 SY£Qf* 

IF( ABS(A(MI.M)>* ABS(A(II + ltM))) 5*10*10 . SYEQf' 

FIND LARGEST ABSOLUTE VALUE COLUMN M,. CALL IT BIG' SYEQft 

MI b H+ 1 SYEQfi 

CONTINUE SYffQh 

BIG « A(MI*M) SYEQn 

IF ( BIG ) 15*100*13 SYEQk 

big « o implies There is no solution sye^ 

IF <MI*» M) 18*25*18 SYEO* 

00 20 jj »M"»N2 SYEQN 

Temp «A (M* JJ) SYEQK 

A<M?JJ> * A (MI » JJ) /BIG SYE^ 

NORMALIZE row mi and EXCHANGE with Row M SYEQfv 

A(MI»JJ)8 temp SYm 

GO To 35 SYEOf* 

DO 30 JJ«M»N2 SYEQf^ 

NORMALIZE ROW M SYEQls 

A(M*JJ) 8A(M*JU)/BIG $YEpf< 

DO 50 II « 1»N1 SYEPf^ 

DO ROW OPERATIONS- TO ZERO ELEMENTS Of COLUMN M EXCEPT' FOR SYEQ* 

ELEMENT A <M*M) SYeQh 

TEMP »A(H*M) SYE^ 

IF (M«I I) 38,50*38 SYEQi^ 

IF (TEMP) 39*50*39 SYEO* 

DO 40 JJ* M*N2;, SYEQ* 

A(n*JJ)8A(H,jJ)„ temp •A(m,UJ) SYEQr 

CONTINUE SYEQi^ 

COnT JNUe SYEOf 

CONTINUE SYEQf' 

RETURN SYEGh 

READ SOLUTION AS N ELEMENTS FROM COLUmN (N*l> SYEQK 

FLAG »1,0 SYEOh 

SORRY THE COEFFICIENT MATRIX IS SINGULAR SYEQri 

RETURN SYEQr 

8 SYEQf 

###*###&#***##**#.#*<*###**#«#**#**###*«.<»*#<»#'#.&#**####**#«■*#<»*•****###**#< 
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c. 

c. 

c 

c 


SUBROUTINE TORKOl 

p 

P 

P 

^DuMAil A I Oi A«* j£t * »“r» .C: t 

COMMC 
COMMC 
COMMC 
COMMC 
CONMC 
COMMC 
COMMC 
COMMC 
COMMC 
COMMC 

commc 
commc 

COMMC 
COMMC 

commc 

gOMWC 
COMMC 
COMMC 
gOMMC 
QOMM( 
COMMC 
COMMC 
COMMC 
Commc 
commc 

£0MM( 
COMMC 
COMMC 

commc 

QOMMl 
COMMl 
COMMi 
gOMMi 
COMMi 
COMMi 
gOMMi 
COHMi 
gOMM 
COMM 1 


common 

A(3) 

» 

AE(5) 

9 

AED<5> 

* 

• 

AFOUR(g) 

9 

AXX< 6 93f>3> 

9 



p 

AIO(S5>3«3) 

9 

AUlO) 

9 

AU T 

9 

4 

AOCJ(&?393) 

9 

AOJ (3) 

9 

AONE (7) 

9 

p 

ATCpTa<3*3) 

9 

AIRBUS) 

9 

A TWO (4) 

9 

4 

Al(3®3) 

9 

Aij<a> 




COMMON 

BDMASS 

9 

BF0UR<2> 

9 

8 MOM 

9 

4 

BoDVOI ( 3e 3> 

9 

80DY0X(3c3) 

9 

BOOvil OoS) 

9 

p 

80MASS 

* 

8 QNEC?) 

9 

BThREECS) 

9 

6 

BTWOC4) 

» 

81 MASS 

9 

B2MASS 

9 

p 

B3MASS 

f 

84MA§S 




COMMON 

CA (3) 

9 

C8(3). 

9 

CGA1NO (3) 

9 

* 

C6AJNM2) 

* 





o 

COSFEJ 

9 

COSTTj 

9 

COSTTO 

9 

4 

COSTTI 

9 

COSTT 3 

9 

C0STT4 

9 

0 

C 02 T 

9 

CPI 

9 

cpe 

9 

4 

•CST 

9 

Cl 




COMMON 

OB (3) 

9 

DDOl<3) 

9 



p 

deltay 

9 

001(3) 

9 

DO'iOOT (3) 

f 

0 

DTlO) 

9 





« 

OTIME 

9 

012(3) 

9 

013<3> 

9 

p 

01300T(3) 

9 

D13yC$ 

9 

013YSN 

9 

4 

D13ZC S 

9 

D132Sn 

6 

0X4(3) 

9 

«' 

DI400T{3) 

9 

014YCS 

9 

014VSN 

9 

$■ 

Dl4Z6g 

9 

DJ42SW 




COMMON 

EEE (3*3)-. 

9 

EEJ (3 9 3 ) 

9 

EL8<3) 

9 

<& 

EL200T (-3) 

9 

EU2YCS 

9 

EU2YSN 

9 

p 

EL 2 ZCS 

9 

EU2ZSN 

9 

EL3(3> 

9 

4 

EL300T(3> 

9 

EU3YCS 

9 

EU3VSN 

9 

4 

EL3ICS 

9 

EL3ZSN 

9 

£L4<3> 

9 

p 

jt 

EtA00T(3) 

9 

Et^YCs 

9 

EU4VSN 

9 

4 

EL^ZCS 

9 

EUA 2 SN 

9 

EMi(G 9 6 ) 


COMMON 

FAT ( 8 ) 

9 





» 

FEE( 6 ) 

9 

FEED ( 6 ) 

9 

FFF<3) 

9 

4 

FFJ<3) 

9 

FLAGl 

9 

flags 

9 

4 

FLAGS 

9 

FLAG4 

9 

PNi 

9 

4 

F0<3> 

9 

FOl (.3) 

9 

F02C3) 

9 

4 

P03(3) 

9 

Fl < 3 > 

9 

Fll <3) 

9 

4 

FPT(g) 

9 





P ‘ 

F12(3) 

9 

FX3<3> 




COMMON 

gaxn,Uo> 

9 

03 - 

$ 



& 

G3DOT 

9 

G4 

9 

G400T 


COMMON 

HO) 

9 

HCMG(3) 

9 

HOOT (3) 

9 

« 

HI (3? 

9 

HO (3) 

9 


9 

p 

HI (3) 

9 

HlPOOT (3) 

9 

HXPRIMO) 

9 

■4 

H3PR|M<3) 

9 

H4PRJM(3) 




COMMON 

IB2F‘ 

9 

•ICFA 

6 

XCFS 

9 

■4 

ICFC 

9 

I CFO 

9 

xdock 

9 

4- 

XDOfMl 

9 





<$ 

XGRAVF 

9 

IPNOLM 

9 

IPNYCK 

9 

4 

iprint 

9 

IPROPF 




COMMON 

NCAgE 

9 

nCheCk 

9 

NOECK 

9 

P 

noaxn 

9 

numCmo 




common 

omegai 

9 

OMEGAS 

9 

OMEGA4 


COMMON 

PEND3L 

9 

PEND4L 




COMMON 

Q ( 4* A) 







gOMM 

comm 

COMM 

COMM 

COMM 

COMM 

COMM 

comm 

comm 

COMM 

COMM 

COMM 

COMM 

COMM 
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oooooooooo 


COMMON s 

R 9 

R0(3> * 

Rl<3)’ 

t COMMC 

• 

R1DQT(3) * 

RiYCS » 

R1YSN 

* COMMC 

* 

RIZ.CS » 

RlZSN 9 

R2 (3) 

« COMMC 

# 

RgDOT (3) * 

R 2 YCS , 

R2YSN 

« COMMC 

# 

R 2 ZCS f 

R2ZSN t 

R3(3) 

* COMMf 

4) 

R3D0T(3) * 

R3YCS * 

R3YSN 

* COMMf 

* 

R3ZCS f 

R3ZSN * 

RA'(3> 

f COMMC 

#• 

RADONS) , 

R4YCS * 

R4VSN 

* COMMC 

4 

RAZC9 » 

R4ZSN 

SINFEJ 

COMMC 

COMMON 

S t 

SDOT f 

• COMMf 

« 

SINTTJ 9 

SlNTTo * 

SlNTTl 

* COMMC 

* 

SinTT2 « 

sinTT 3 , 

SINTT4 

* 5 OMMC 

4» 

SP ♦ 

SUM! * 

SUM2 

* COMMC 

• 

SUH3 f 

S2(3> * 

S3 (3) 

* COMMC 

4 

COMMON 

54(3) 

T<3»3> $ 

TC(3t3) * 

TEMPI <3) 

COMMC 
* COMMC 

« 

♦ 

TEMP2 (3) 9 

TEMP3(3> * 

T£MPA( 3 ) , 

TEMP5<3*3> 

COMMC 
9 COMMC 

# 

TEMP 6 (3»3) 9 

TEMP7 <3*3) * 

TEMPS <3*3) 

9 COMMC 

# 

TEMPO (3*3) * 

TEMPlO {3*3} * 

TEMPll (3*3) 

* COMMC 

# 

TemP12{3»3> * 

TEMPl3(3*3) * 

TEMPi4<3*3> 

* C°MMC 

* 

TEMP15 (3*3) * 

TERMI (3) * 

TERM2(3) 

* COMMC 

* 

TFRjCT * 

THATA( 6 ) , 

THATAD< 6 ) 

9 COMMC 

*■ 

THETA1 9 

THETA 3 * 

THETA* 

* COMMC 

* 

theto , 

TJBO (3,3) , 

TIBOI (3*3) 

* COMMC 

4 

TIME f 

TJ * 

TJ1 (10) 

* COMMC 

* 

TJ2U0) * 

Tj3(i0) * 

TJ*(10) 

* COMMC 

4 

4 

tmotoR * 

TOEF (3) * 

TOTMAS * 

TO! 

COMMC 

9 COMMC 

#• 

TQ06 (3) * 

TQOP<3) * 

TQ1<3(3) 

* COMMC 

* 

TQ1P<3> * 

TSTART f 

TSTqP 

* COMMC 

4 

TT100T * 

TT3DOT * 

TT4D0T 

9 COMMf 

# 

T1EF (3) * 

T13 , 

Tl* 

COMMC 

COMMON 

common 

V(3) 

W0<3> * 

WS 9 

Wt(3) 

COMMC 
* COMMC 

* 

common 

W3 (3) * 

X(&C?) 9 

W4(3) 

XC f 

XCOOT 

COMMC 
9 COMMC 

* XMU COMMC 

COMMC 


« 


#' 


# 


This SUBROUTINE COMPUTES The torque between body 0 AND body 1. 
this torque consists of the- control torque and friction torque. 

if- (Time ,ne. tstaRT) eo To 10 

XC**»0AIN <2) #0MEGA 1 

AfOUR(2)«XC 
10 continue 

AfOUR ( 1 )*TIME 
BFOUR(l)aQELTAT 

xcooTbqasn(3>#( omega i *»sp ) 

Br0UR.(2)«XCD0T 

CAtL FOMS (AF0UR*BF0UR,2»FLAo4tTjA) 

Xc«AF0UR(2) 

TMOTO«aGAIN(2)#OMEGA.l*XC 

TFRICT«GAi n( 1 >#$iN(QmEGAi> 

T OlaTMo T OR*TpRxcT 

return 


TORKC 

TORKf 

TORKC 

TORKC 

TORKC 

TORKC 

TORKC 

TORkc 

f.ORKC 

TORKC 

TORj<f 

TORKC 

TORKC 

ToRkc 

TORKfi 

TORKCj 

ToRkc 

TORKC 
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0 TO?K< 

C * 

c * 

End 
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onoo ooooooo 


S09H0UTINE T0RK13.(TU»CP1 #CP2»THETA3*oMEGA3) 
# 

« 


This subroutine computes The torque between body i and bOoy 3* “°* K? 

this torque consists op the control torque and friction torque. 


Ti3 m * 

return 


CPi#0MEGA3 - CP20THETA3 


torki 

TORK1 

TORK1 

T0«Ki 

TORKJ 

TORKI 


# 




end 
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SUBROUTINE TORKl ^ ( T H 8 CP 1 9 CP2 1 THETAS * oMEOAA ) 
» 


ft 


TORgl 
TO*K5 
YORK I 
tORKl 

torki 

TORK3 
TD^K 1 

ft 


t hjs subroutine computes t^ Torque between boot i and boot 4« 
thjs torque consists op the control torque and friction torque, 

Ti4 s j ~ CPl«0MEGA4 - C p £«(TheTa^ . 3 0 l4lS9) 

return 


ft 


END 
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c 

c 

c- 

c 


SUBROUTINE xdot 
a 
•a 
a 


common 

A<3) ♦ 

AE(5) , 

AE0(5) 

t COMMC 

a 

AF0UR(2) f 

An(6 > 3 l 3) t 

ALT 

COMMC 

a 

AI0(6»3*3> f 

AJ1 (3) , 

t COMMC 

#■ 

AOCJ (6*3f 3) » 

AOJ (3) t 

AONE (7) 

* COMMC 

# 

ATCpT2<3»3) » 

ATHREE(S) , 

ATWO(A) 

9 COMMC 

a 

A1 (3|3) » 

Ai J (2) 


COMMC 

'common 

BDMASS t 

BFOUR(2> f 

bmom 

t COMMC 

a 

BODYOI (3»3) * 

900YQl(3f3> 9 

B0OY1 1 ( 3 f 3 ) 

9 COMMC 

#■ 

bomaSS , 

BONE (7) 9 

B t HREE<5) 

f COMMC 

* 

BTWO(4) » 

BIMASS » 

B2MASS 

9 COMMC 


B3MASS i 

B^mASS 

C0AinO{3) 

COMMC 

'COMMON 

# 

CA (3) » 

CqAinX (2) * 

CB(3) , 

9 COMMC 
COMMC 

a 

COSpEJ p 

COSTTj , 

gO^TTO 

t COMMC 

♦ 

COSTT1 » 

C0STT3 9 

C0STT4 

9 COMMC 

a 

COST » 

CPI 9 

CP2 

9 COMMC 

-a 

C ST 9 

Cl 


QOMMC 

COMMON 

DB<3> » 

0001(3) 9 

DO'1DOT(3) 

COMMC 

*• 

•OEUTAT » 

DO'l<3) t 

9 COMMC 

a- 

0TI{3> » 


0X3(3) 

COMMC 

a 

OTIME » 

012(3) , 

t COMMC 

-a 

D1300T<3) 9 

0l3yCs 9 

0X3YSN 

9 COMMC 

a 

DUZCS 9 

D13ZSN , 

0X4(3) 

.9 C°M« c 

4 

0X4IJ0T(3) » 

OHYCS 9 

0X4Y5N 

9 COMMC 

a- ' 

Ol^ZCS * 

D14ZSN 


COMMC 

COMMON 

EEE (3*3) » 

EEJO 93 ) ♦ 

EL2 (3) 

9 COMMC 

a 

EUSOOTO) 9 

EL2YCS 9 

E12YSN 

9 COMMC 

a 

EU2ZCS. « 

EL.2ZSN 9 

EU3(3> 

9 COMMC 

a 

£L3D0 T (3) 9 

EL3YCS » 

E1.3YSN 

9 COMMC 

a 

EU3ZCS 9 

EU3ZSN 9 

EUM3) 

9 COMMC 

a 

• El,4pOT(3) 9 

EL4YCs , 

EL4YSN 

9 COMMC 

#• 

EL4ZC S t 

EUZ S N 9 

EM<696) 

COMMC 

COMMON 

FAT (8) 9 

FEED (6) , 


- COMMC 

a 

FEE (6) 9 

FFF (3) 

9 COMMC 

a- 

FFJ(3) 9 

FLAG1 9 

FLAG2 

f COMMC 

* 

FLAGS- 9 

FLAG4 , 

FNi 

9 COMMC 

* 

FOO) 9 

F01<3> 9 

F02 (3) 

9 COMMC 

# 

# 

F03 (3) , 9 

FPT(S) ? 

Fl (3) , 

Fi 1 (3) 

9 COMMC 
COMMC 

♦ 

F 1 2 ( 3 ) ? 

F13 (3) 


COMMC 

common 

GAIN (lo) 9 

G 3 ; 9 


COMMC 

a 

G 300 T 9 

G4 9 

G4D0T 

cOmmc 

COMMON 

H ( 3) * 

HCMG (3) 9 

HDOT (3) 

9 COMMC 

a 

HX<3) 9 

H0(3) 9 

HW(0> 

* COMMC 

a 

HI < 3 > 9 

h1P00T{3) 9 

HXPRIM{3) 

9 COMMC 

•a 

. H3PRIM(3> 9 

H4PRIM(3) 


COMMC 

COMMON 

IBS?- » 

ICFA 9 

JCFB 

t COMMC 

#• 

ICFC ; e 

ICFD 9 

IOOCK 

9 COMMC 

-a 

XDOFT 6 ) 9 



COMMC 

a 

I^RAVF ! 9 

-|PNDLM 9 

IPNTCK 

» COMMC 


I PRINT 9 

IPROPF 


COMMC 1 

COMMON 

nca§e 9 

NChECk 9 

NOECk 

f COmmc; 

-a 

ngajn f 

-numcmg 


COMMC 

common 

0ME6 a 1 9 

OMEGA 3 9 

0MEGA4 

COMMC 

,=.common 

PEN03U 9 

PENQ4L 


COMMC 

common 

G (4i4) 



COMMC 1 


C-56 



C 9. *♦».#*■ ». 


C 

C 

C 

c 

c 

c 

c 


COMMON 


» 

* 

* 

# 

# 

« 

< 

* 

# 

# 

# 

4 


COMMON 


COMMON 


« 

*■ 

# 

a 

• 

4 

4 


COMMON 

COMMON 

common 


R 

RIOOTO) 

R1ZCS 

R200T (3) 

R2ZCS 

R3DQT13) 

r 3ZC s 

R4DQT ( 3 ) 

R4ZCS 

S 

SINTTJ 

SINTT2 

■SP 

SUM3 

S4(3) 

T (3*3) 

TEMP2<3) 

T£MP3(3> 

TEMP6<3»3) 

TEMP9(3j3) 

TemP12(3»3) 

T£MP15(3»3> 

TFRICT 

THEtAi 

theto 

TIME’ 

TJ2U0) 

TmoTqR 

T'0EF(3) 

TQ0Q<3) 

TQlP(3) 

TTiOOT 

T1EFO) 

V(3) 

WO (3) 

W3(3) 

X (6,7) 

XMU 



R0<3> ♦ 

Rl<3> 



R1YCS « 

R1YSN 



RUSN , 

R2 (3) 



R 2 YC S , 

R2YSN 



R2ZSN , 

R3.<3> 



R3YCS , 

R3YSN 



R3ZSn , 

*4(3) 



R4YCS * 

R4YSN 



R4ZSN 




SOOT , 

SINFEJ 



SINTTo « 

SINTTl 

9 


SINTT 3 , 

SINTT4 



SUM1 » 

SUM2 



S2 (3) 1 

S3(3> 



TC (3*3) t 

TEMPI ( 3 ) • 



TEMP^O) ♦ 

Temps (3*3) 



TEMP7 0*3) # 

TEMPS < 3 #3) 



TEMPlO (3»3) * 

TEMPI 1 (3»3) 



TEMP13 (3*3) « 

TEMP14(3*3) 



TERM! ( 3 ) , 

Terms ( 3 ) 



THATA<6) , 

THATAD{6) 



THETA 3 , 

theta* 



TlB0(3,3> « 

TIBo! (3*3) 



TJ * 

TJK10) 



Tj3(l0) * 

TJ*<10> 



TQTMAS t 

TO! „ 



TQ0P(3) ♦ 

TQ i l3(3) 



TSTa«T , 

TST 0 P 



TT300T ♦ 

TT’400T 



T13 . 

T14 



WS » 

W*(3) 

Wl(3) 



XC , 

XCDOT 



COMMC 

COMMC 

COMMC 

com*c 

COH*C 

CQVffiZ 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 

COMMC 


COMMC 

#####*******######** #«#«*#**#O*****#*#**a**##»##**O#tt0&#####'»*-!M}.***««# < 
4 


# 


# 




SINTTl ■« SIN(THETAI) 

COSTTj B; COS(TheTaI) 

WKl) » WOd) * OMEGA 1 

Wl(2) m . W0(2)*C0STTi ♦ W0(3)»SlNTTi 

Wl(3) m -WO(2)PSINTTl ♦ W0(3)»C0STT1 

IF (Time ,ne. tsT a «t, qo t 0 2 
CAUL RECAUC 
2 CONTINUE 
CALL' SDCAUC 

EU2D0T (1 ) -* •Wi(3r»EU2t2) ♦ Wl(2)*EL2{3) ♦ $2(1 >»SqoT‘ 
6W200T ( 2 ) 0 Wl(3>*EL2 U > •■Will > *EC2 ( 3 ) ♦ S2 <£> *S 00 T' 

EL2D0T(3) » »WU2)*£L2U) ♦ W 1 U)*EL 2 ( 2 ) ♦ S2(3)*SooT 
ROU) * Rl(l) • DOlU) 

« 0 ( 2 > * RU 2 )^OSTT(.-jR.lX 3 )^^TTt - DOKZ) 

RO (3) a R1 ta^SfNTri^ RK3)^C0STTf - Dot (3) 

W3(l) * Wl(X) 

#3 {21 * OMEGA 3*S3*2) # - *1 ( 2} * 


XQoT 

XDOT 

XOOT 

XDOT 

XQOT 

XDOT 

XDOT 

xoof 

XQOT 

XQOT 

XQOT 

XDOT 

XQOT 

XDOT 

kqoT 

XDOT 

XDOT 

xdo? 


G»5 7 



c- 


W3 (3) a 0MEGA3*S3(3) ♦ Wl(3) 

EL3D0T<1> • «W3<3) # EL3<2' ♦ W3<2> # EL3<3> 
EU3D0T(°) ■ W3(3) # EL3(1) - W3U)*EL3<3> 
EL3D0T ( i) m ~W3(2)*El.3U) 4 W3(1>*£L3<2> 
#4(1) ■ Wia) 

W4<2) 9 QMEGA4#S4(2) 4 WU2) 

W*(3> • 0M^QA4#S^<3) 4 Wl<3) 


EUOOTU) 
EL4D0T ( i> 
EU4D0K i) 
OOlOOT < l) 
DQ1D0T (2> 
DOIDQTO) 
013OOT(i) 
D13DOT<2> 
D13DOT (3) 
OUDOT(i) 
D1400K2) 
01400T (3) 
«lDOT(i, 


* 

* 

m 

m 

n 

m 

m 

« 

u 

m 


«W4(3)*EL4<2> 

W4 (3) # EL4 ( 1 ) - 
-W4{2)*EU4(U ♦ 
•»W0(3)#D0l (2) ♦ 
W0(3)*D0lU> »- 
-WO(2) #001(1) ♦ 
•Wi <3)#013<2) 4 
W1<3)*013(1) - 
-W1 <2>*013<1) 4 

-Wl(3>#DH<2) ♦ 


W4(2)#EL4<3) 
W4(i)*EL4<3) 
w4{lH*Et.4(2) 
WO(2>#D<H(3> 
WO ( 1 ) *DQl <3> 
W0(l)*D0l<2) 
Wl(2)*0l3<3) 
W1 ( l ) *013 (3) 
W1 (1>*D13<2) 
Wl (2)*0i4 (3) 
W1U>«DU<3) 
W1 < 1 ) *014 <2) 


# 

# 

f 

* 

f 

# 

« 


«iD 0 T( 2 ) 


R100TC3) 


W1<3>#014<1> 

Wl(2)*0i4<l) 

(BOMASS/TOTMAS) #001D0T < 1 ) 

«( B2MASS/T0TMAS ) #ELHDOT < 1 ) 

-<B3MASS/TOTMAS)*<013DOTQ) 4 EL3DOT(l>) 
»{B4mASS/T0TMAS)*(D14D0TU) 4- ELAOOTU) ) 

< BOMASS/TOTMAS) * * DO lOOT ( 2 > * C OSTT X 4 DOiDOT (3 ) # SXnTTi‘) 

« (B2MASS/T0TMAS)#EL2D0T(2) 

*<B3MASS/T0TMAS)#(D13D0T(2) 4 EL3Dor<2>) 
-*(B4MASS/T0 TmaS)»(D14D0T{2> + EL4DOT<2>> 

■ (BOMASS/TOTMAS)* (-DOIDOT ( 2 ) *SINTT 1 4 DOlDOT <3)*COSYTl) 
- (B2MASS/T0TMAS)*EL2D0T(3) 

-(B3MASS/ToTMAS)*(D 1300T(3) 4 Ei,3D0T<3)> 
»(B4MASS/T0 TMAS)#<d14D0T(3) 4 EL4D0T{3>) 


R2D0T ( 1 ) ■» R1D0T<1> * EL2DOT(l) 

R2D0T (2) * RlOoT (2) 0 EL 2 D 0 T< 2 > 

R2D0T(3) a RlDOT (3) <■ EL2DOT<3> 

R300T(1 ) » RlDOT (D ♦ D13DOTU) ♦ EL300TU) 

R3dOT( 2) a RlDOT (2) 4 d13D0T<2> ♦ £L360T(2) 

R3pOT ( 3 ) »■ RioOT ( 3 ) 4 D13D0T<3) 4 EL 3 d 0 T< 3 ) 

R400T < 1 ) » RlDOf<l> *Di400TU> ♦ EUoOTU) 
r4 D 0T(2) » Rlooy (2) 4 Dl^D0T(2) ♦ EU4 qOT (2) 

R^DOT (3) * R1DoT(3) ♦ D1400T<3) 4 EL4 0 oT(3) 

CALL' MULT<MG,B00W*W0 f DUM,DUMrDUM9l> 

CALL MUL'T (Ml 9 BODY 1 I #Wj »DUM»DUM*DUM* 1) 


H3PRIM(1) a 
H3RR|M(2> a- 
H3PRJM(3> a 
H4pRlM(l) «. 
H4P8jM(2) a 
H4PRIMO) 9 
HlPRlM(2) -*• 

* •BZMASS#! 

* «B3MASS*< 

* -B4mASS# ( 
HIP^IMO) a 

* *B2MASS#( 

* -B3mass*< 


B3mASS*(« 

B3MASS*( 

B3MASS*’(' 

B4 M ASS»(« 

B4MASS*! 


•EL3(3)*R3DOT(2) 
EL-3(3) *R3DOT (1) 
■EL3 (2) *R3D0T ( l ) 
-EL 4 <3)*R4D0T(2) 

ELA(3)*R4D0Tu) 


4 

if 


B4MASS # ’( *»EL4 ( 2 ) *R4D0T { 1 ) 


HI (2) * H3PRIM(?) 

- Ei.2 (3) *R200T (1) 

- D13(3)*R300T(1) 

- D14(3)*r 4D0T(1) 
HI (3) ♦ H3PRlM(3) 
EL2(2)*R2D0T<1) - 

.. „ . D13(2)*R3dOT(1) - 

*• -BAMASS^ D1412) # R4dO t (1) » 
if (Time- *ne« tstaRT) go to s 


EL3(2>«^300I(3)) 
EL3<l)4R300T(3n 
EL3(l)*R300f (2)) 
EL^(2)*R400f (3) ) 
EL4 ( I ) #P4DOT ( 3) ) 
EL4 < 1 ) *R40OT ( 2) ) 
H4PRIm(2>. 

EL2(l)*R2DOT (3) ) 
013(1)*R3D0T<3)) 

014 ( 1 ) *R4D0T (3) ) 
H4P«IM(3) 


EL2:(l)»R200T(2)) 

0l3,(i)*R3D0T(2)> 

B14(1)*RaoOT(2)) 


HIPRIM(I) a Hl(I) * H3PRXMU) 4 H4 PRi M (1) 

*- -»B2«ASS#-(£t2<3) * R 20OT(2) «• EL2 (2) *R2D0'f (3) ) 

4 •B3MASS*-(D13(3)'»R3D0T(2> - 013 (2) # R3D0T (3) ) 

‘•B4mAsS*(D14(3)*r4dqT(2). . 014{2)*r4DOT(3>) _ 

LET^-US DEFINE SOME INTERMEDIATE VALUES NEEDED TO COMPUTE Hi 


XDOT 

XDOT 

xoof 

XDOT 

xddT 

xoof 

XDOT 

X&OT 

XDOT 

XDOT 

xooT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XOOT 

XDOT 

XOOT 

XQOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XQOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

XQOT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

X0OT 

XQOT 

XDOT 

XDOT 

XQOT 

XDOT 

XQOT 

XDOT 

XDOT 

XDOT 

XDOT 

XQOT 

XDOT 





$UMl o BlMASS*RlD0T(i) * B2MASS®R200T U ) 

* ♦B3MaSS*R3D0T( 1) *> .B4MAS$<*R4D0TU) 

SUM2 a b!MaSS«R1D0T<2) * B2MASS*R2D0T <2) 

* *B3mAsSOR3DoT(2) «> B^ASSOR^DQT (2) 

SUMS ■ BImAss^RIDoIO) ♦ BZmASS*R8D0T<3> 

* 0B3MA»SoR300M3) ♦ B4MA SS « R 4Q0T'(3) 

c CALCULATE h« 

DO 4- I ts i © 3 . 

HCmQU) a FFF(X) 

DO 4 Jol93 

HCMG(X) -a £EE(ieU)^0(J) ♦ HCMG(X) 

• 4 CONTINUE 

HU) a HOU) $ HSPRSMU) 

* *<°DQX(3)OCOSTTl 0 DOJ (2 )»SxnTTI)oSUM2 

» *( DOl (3)^©iNTT| ♦ DOX (2 )*COSTT{)' cj SUM3 

* * HCMGU) 

H42) » HO(g) « C0 STTj<»HJPRIH< 2) ~ SlNTTl4HlPRlM<3) 

* ♦ 00 1 < 3 ) °§WMi - 00lU)<»SINTTl*SUM2 • OOKi^COSTTX^SUMS 

* * HCmG<2> 

H<3) a HO (3) « §2NTTi<jmP«XM<2> * COSTTjomPKIMO) 

» « D0l(2)»SUMX ♦ DOlU^COSTTl^Sl^ « 001 U> ^SXNTTJ°SUM3 

» * HCMG (3) 

5. conTxnue 

C COMPUTE THE UNIT VECTOR JU 

AU1U) b B2MASSOEL2U) 

* ♦B3MAS9*<H3‘U) * B3MASS#EL3 < 1) 

* oS^mASS^Dx^U) ■> B4mASS«EL^U) 

. AJH2) a B2MASS®EL2-(2) 

*. oBSMASS^DlS^aj B3MASS«EL3 <2> 

#• *B4mASSoDX^ <2:) o BA^ASSoEl 4 (2) 

AUK3) a BgMASS0Eu2(3) 

* oS-3MAS$^DX-3«3) BSMASS^ELS (3) 

* <>B4MASS«0l4'(3) * 84 mASS®EL4 (3) 

c update the orbit angle 

theto » TIME«WS 

IF: U GRAVE e EQ 0 0) ©O' TO 10 

c calculate the gravity gradient forces and ToRQUeS® 
call ggrad 
10 CONTINUE 

c su m The forces on body zeRo 0 

FOU) B FO|U) 

FO(g> a FOl (2) 

F0<3) B FOl (3) 

c sum the forces on body one® 

F1U) 8 Fit(l ) 

FU2) a FI 1 (2) 

FI (3) B FI 1(3) 

c sum the torques on body zero 0 

TOSFU) O TQOGU) ♦ TQ0PU). 

T0gF(2) a TQ0G<2) ♦ TQ0P(2) 

T0EF(3> a TQ0G<3> ♦ TQ0P(3> 

c sum the torques on boot one, 

UfF(l) a TQlGU) <■ TqIPU) 

T lEF (2) O' TQ1G(2) o Tqxp.< 2 ) 

T1EF (3) a TQ1G(3> * TQ1P(3) 

C LET US DEFINE some XNTERmEDxATE TERMS USED TO CALCULATE* HDOTc 
TERMXU) O (BomASS «• TOTMAsvoDOi U> ° AJ1(1) 

TERMi(g) a (BOMASS • ToTmaS)ODOU2) 

* «* cosm^Ajua) * sjntti<»auit3) 

TERMl (3 ) b (BomASS ° T 0 TMAS)oD 01(3> 

* SjnTTi<vaj 1 (2) 13 CoSTTi» a ji(3) 

T6RM2U) « BOMASS*DO-i ( V *» AJH1) 


XQOT 

XDOT 

XDOT 

XOOT 


XDoT 

XqoT 

xqoT 


xoo? 

XDof 

XOOT 

XDOT 

XDOT 

XQOT 

XDOT 

XDOT 

XOOT 

XDOT 

XDOT 

XqoT 

XDOT 

XDOT 

XDOT 

XDOT 

XDOT 

X0OT 

XDOT 

xdot 

XDOT 

XDOT 

XqoT 

XOOT 

XDof 

xdot 

XDOT 

XDOT 

xdot 

XDOT 

XOOT 

XDOT 

xbof 

XDOT 

xdot 

XQOT 

XDOT 

XQOT 

XDOT 

XDOT 

XDOT 

xdot 

xdot 

xbof 

XDOT 

xqo! 

XDOT 

XDOT 

XDoT 

XQO? 

XDOT 

XDOT 

XDOT 

XDOT 
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TERMS (g) » BOMASS# < C0STT1#D01 <2> * StNTTX*001 (3> > * AJ1<2> 
TERM2<3) ■ BOMASS# (-SlNTTl*D0U2) ♦ CoSTTX#DOl(3>> - AJ1 <3> 
ATCPT2Utl) - 0* 

ATqPT2 < 1 *2) ■ «TERM8(.3) 

AtCPT.2(i»3) • TERMS <g> 


ATCPT2 (2* 1 ) » C0STT1#TERM2(3> 
ATCPT2(2,2) « «SinTT x#TeRM2< X> 


♦ SJNTtl # TERM2(2) 


XOOT 

xpoT 

xeoT 

xdot 

xoof 

XQOT 

XOOT 

XDOT 

XDOT 

xqoT 

XDOT 

XDOT 

X§oT 

XDOT 

xdot 

XDOT 

XDOT 

XDOT 

XOOT' 

XDOT 

xdot 

XDOT 

XQOT 


ATCPT2<2»3) ■ -C0STTl#TERM2(l> 

ATCPT2(3»1) « SlNTTl#TERM 2 (3) - CoSTtX*TERM 2 (2) 

ATCPT2(3*2) ■ C 0 STTj#TeRM 2 { 1 ) 

ATCPT 2 <3»3> » -SINTT1#TERM2U) 

HDOTU) # WO (3>#H<2) • WO(2)#H(3) . _ 

# M-TERMi(3)*F0<2) ♦ TeRMX (2>*FO<3> J/TqTMAS 
#♦ UTCPT2 U * 1 > #Pl < X ) #ATCPT2 ( 1 ♦ 2 ) #FX ( 2) *ATCPT2 U »3 > *F1 <3> > /TOTMAS 
#♦ TOef(i) 4 TlEFU) 

HOOT <2^ * •WO<3>*hU ) + W0<X ,# H<3> 

# ♦ < TERMl<3)#FOU) • TERMUl)«F0(3))/T0TMAS 
#*(ATCpT 2 ( 2 *l)#FX(l>*ATCPT 2 { 2 » 2 )#Fl( 2 ) + ATCpT 2 ( 2 f 3 )#Fl( 3 ))/TOTMAs 
#♦ TOEF (2) ♦ COSTTl#TXEF(2) - SINTT1 #TiEF(3) 

HOOT (3) * WO(2)*HU> •• W0(1)#H(2) 

# ♦ (.TeRMI (2)#F0(1) * TeRm 1 < 1 )*F 0 ( 2 ) )/T 0 TMaS 

# ♦(ATCPT2(39l)#Fl<l)*ATCPT2(3»2)#Fl(2) + ATCPT2(3t3)<»Fl(3))/TOTMAS 

V TOEFI3) ♦ SINTTl#TlEF(2) ♦ C0STTl*TlEF<3> „ _ _ 

calculate the toRque between body o and body i, (conTRol*fRicTion)XdoT 

CAUL TORKOl XQOT 

HlPDOTU) « -W1(2>*H1PRXM(3) ♦ ttl <3 ) «hXPRIM<2) XDOT 

*■ ♦R1DOT(2)#(.82MASS»EL2DOT(3)«B3MaSS* ( d 13DOT(3>+E1.3DO | T (3>>- XQo! 

# B4MASS» <DJADOT (3)^EUOOT<3> ) WRlOOl ( 3 ) # <-B2MASS*El2D0T (2) - XDOT 

# B3MASS# (DX3D0T (2) +EL3DOT ( 2 ) ) - 8 AMASS* (DlAOOT <2> ♦ELADOT <2> ) ) XOOT 

♦•AJU2) # (»FO (2)#SxNTTi/T0TmaS<-F0 (3) #CoSTTi/ToTMAS) XDOT 

♦♦AJX(3>*( FO(2)#COS;TT1/TOTMAS*FO(3)#SiNTT1/TOTMAS) XDOT 

#*Ajl<3)*Fl(2)/fOTMA5-Ag!<2)*Fl<3)/TOTMAS*TXEF'a>#Tol XDOT 

CALCULATE The ToRqUE BETWEEN body 1 and BODY 3* <CONTRoL»FR1CTioN) XDOT 
CALL TORKi3<TX3tCPl*CP2,9THETA3*OMEGA3) XQOT 

S300T«*S3 (2) # <Wl <3K#H3PRIM<1 ) *W1 U ) #H 3 PRIM (3) > -S3 < 3 ) »•< WX ( 1 ) *H3pqlMXDOT 
*<2 )-Wj (2)#H3PRIM(X) )*B3MASS4S3(2)*(El 3DOT (3>*R3DOT<i>-EL3DQT<l)*R3X6oT 
#DOT (3) ) *B3MASS#S3 ( 33 # ( EL3D0T ( X > #R3DOT { 2) -EL3D0T (j?) *R3D0T ( I ) ) - XDOT 

* (B 3 MAss/TOTMAS} *S 3 (2) # (EL3 <3> * <PO ( X > *FX (X > » -EL3 < 1 ) <M-Fo <2> *SlNTTl*XDoT 
#FO (3) #C 0 STTj*F 1 (3) ) ) *<B3MASS/ToTmaS> *S3 <3> » <EL3 < l) MFD ( 2 ) AcqSTTj* XqoT 
#F0(3)#SINTTX*F1(2))-EL3<2)*(F0<1)+F1(1> > UT13 XDOT 

CALCULATE THE TORQUE BETWEEN BODY X A N D BoDY A, <ConTROL*PRICTION)XDOT 
CALL T0RKXA(TlAtCPi*CP2:*THETAA f 0MEGAA) XqOT 

GADOT«-SA < 2 ) # ( W X < 3 ) #H APR X M ( U - W XU ) *H4PRIM < 3 >> -S A 1 3 ) #'< W 1 < 1 > #HAPR I MXDOT 

# < 2 ) -W 1( 2 > #HAPR I M < 1 ) -> *8 AMASSPSA ( 2) M ElAOOT( 3 ) #RADQT ( l ) -ElAOOT < X ) *RAxDOT 

*DOT <3) ) ♦BAtfASSftSA (3) » (ELADOT (1 ) oRAD0T|2) «ELApOT (2) AR 40 OT ( i ) XQOT 

# (B 4 MASS/TOTMAS) #SA # (ELA (3) # (FOU ) +f?l ( 1) > -ELA ( X) »(-FO«2> #SINTT1*XD0T 
#FO <3 ) #COSTT 1 *F \ ( 3 ) )-)— < B*MASS/TOTMAS> #§A ( 3) # (gfcA ( X ) * ( FD <2) *C0STTX ♦ XOOT 
#FO <3> #SINTTX*FX {2X HELA (2) # {FD ( 1 ) *Fl < X > ) ) *Ti4 XOOT 

RETURN XOOT 

<»#*##***##*#*##*»*#'*#***#**«*##**#»#**#»*****<M>*##*A**##***#*#***’*#*fl.#< 

* 

* 

* 

END- 


n-fin 
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FLOW CHART & BLOCK DIAGRAM 
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Application . 
Procedure 


TNPiiT MOTiirT.K gonttnuto 


, Dote . OCTOBER. 1 9.7.0- 


. Page of 5 


.Drawn By GARY J OHNSON 


CONTINUED FROM THE PREVIOUS PAGE 



- 1 

1. 

*i- 4 

i • 


CONTINUE TO THE NEXT PAGE 
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*« a ^FL'OWWART T BUOCK'DrAGR AM 


r,'«* re ' i roj-oi 


/'fr. rj*jo ' 

Procedure- 


INPUT MODULE CONTINUED 


_5 of 5 


.Drawn By GARY JOHNSON 


CONTINUED FROM THE PREVIOUS PAGE 
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FLOW CHART & BLOCK DIAGRAM 

Fork DEN 1103-Ot (4-64) 


Procedure., 


----- 

j 

”J" r 

■ ENTRY POINT PROH THE OUTPUT BLOCK 


, Dote. OCTOBER 1970 Paoe 1- nf 12. — - 

_ Drown By_ GARY JOHNSON 


®3 “ ^-,1 * w 0x + ”5,2 * w 0y + **5,3 * v 0x 

■ - + ^5 4 * + *5 3 * n 3 + 6 * C 4 

,°4r-%Vl * iW 0* V * w 0y + “fi’s * - 

_*:«! + H 6,5* fi 3 +M 6,fi’ 
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FLOW CHART & BLOCK DIAGRAM 

F -V C£ . lie 3*:» <--C- 
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Application. 
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FLOW CHART & BLOCK DIAGRAM 

■ J ' F*» I 1 i'-S - 1 1 
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FLOW CHART & BLOCK DIAGRAM 

roxu DEN 1. 1 03 - 01 

App[trn>?nn SUBROUTINE ATT CONTINUED Date 


Procedure Drawn By, ! 





*n»; puiw.’ oi 


I 


FLOW CHART & BLOCK DIAGRAM 
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FLOW CHART & BLOCK DIAGRAM 

; ,-v EtC« i »oa- oi 

Application 
Proct?duro_ 



SUBROUTINE CHG CONTINUED 


Do*& OCTOBER 1970 Pnno 2 of 4 

___ Drawn By ^GARY JOHNSON ^ 






FLOW CHART & SLOCK DIAGRAM 


F«** DEN 1101.01 


Application. 

Procedure™ 


.Drawn By GABX_JfiMSSE.._ 



TEHPl^ 

IH<Pl y 

TEMPI 


00 J * “°j,2,l * ?J " 30 J * * Jj 

S0 J * * 0 J + C0 J * * 0 J 

C9 J * *• C0 J * 0 J + *“ 3 , 1,2 * Jr + *“j,i,3 * SS J * 

S9 J * ^,3,1 * C0 J * 0 3 + *“3,3,2 * 9 J + A “j,3,3 * S6 J * 0 . _ 

S0 J * S9 J * * 0 J + AII Jj J.,2 * 9 J + m j,1.3 * 2 8 J * V 

C0 J * i>“j,2,l * CS J * 0 J + A J I J,2,2 * 9 J + *“3,2,3 * S0 J * 0 j] . . 

S0 J * C0 J * 1 * C0 J * 0 J. + “*3,3,2 * V “*7,3,3 * SB J * 0 3. ] 

" S0 3 * C0 3 * £“*3,1,1 : C9 J * 0 3 + “**.1,2 * B J + “*J,1,3 : “j * 0 3 

S0 3 * £“*3,2,1 * C9 J * 0 3 + “*J,2,2 * 9 J + “*3,2,3 * S9 J * V . - 
C0J * c 9j * [aii j>3>1 * c 0J * 0J + axi J j3>2 * 8j + aii j>3>3 * S9j * 0J ] 

\j * S9 J 

- H * C8 * 30. 

g3 3 J 

H * CB * C0_ 

•gj J J 

TEMPI + TEMP2 + TEMP3 
[O.Cj] * TEMP4 

"“3,1,1 
A0CJ 3,2.1 
A0CJ J 3 1 

C0 J *""3,1,2 + S0 j*""j, 1,3 
C0 3 * ""j,2,2 + 30 3 * ""j,2,3 
C0 J * A0CJ 3,3,2 + S0 J * ""3,3,3 

" 30 J * ""j,l,2 + C0 3 * ""3,1,3 
-. E 0 J *AOC3 W + C0 J *A° CJ W 

- *»j * *°"j.3.2 + C0 3 * ""3,3,3 
[iOj] * TEMP5 

XEMP6, , 


C 0J * TEMP6 2 l 


S0 J * TEMP6 3>1 


: tehp7 3,i 

,l***h ,2 

TEHP7 3 3 

TEkp8 l’l, 
• ™ E 8 1 , 2 : 






F 



C 0J * TEMP6 2 2 - S0J * TEMP6 3 2 
C0j * TEMP6 2 3 - S 0J * TEKP6 3 $ 

80j * TEMP6 2 ’ 1 + C0j * TEMP6 3 ’ l 
S 0J * TBMP 6 2 2 + C0 j * TEHP6 3 2 
S0j * TEMP6 2 3 + C0 j * TSJP 6 3 3 

r ®j, * ""3.1,1. + S0 J * S9 J * ""3,1,2 - S0 J * * ""3,1,3 

ESjl * AOt ¥-J,?,l + S0 J * S0 3 * A0CJ j,2,2 - S9 3 * C0 J * ""3,2,3 

9Q j' * A0Gj j,3,1 + s0 3 * S9 J * ""3,3,2 “ S0 3 * C0 J * A0CJ 3,3,3 

* ""jjl-,3* 

* A0CJ J,2,3' • 

: Wj * A0CJ 3,3,3 

'<»* * "" W + C0 J * “j * ""j,l,» 

. J - 60, * ce T * aocj t „ , + C0 T * ca * aocj t „ , 
,2,-1;- -J- <-J‘- - J,2j2 - • 3- J- j,-2»3i 

- 30.' * cej * AOCJ. „ . + C6' * C9. * AOCJ 
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t *.«* DFA 1 103‘OF I 


Applied Hon . 
Procedure 


Drawn By GA&Y_JQHHS.QK 



[TEMP9] - [-IIj] [TEMF8] 

TEMP 10, , » C9. * TEME9, 

1,1. J 1, 

TEMPlQ^ 2 « C9j * TEMP9^ 
TEHPIOj^’j = C9j * IEMESj^’ 

IEMP10 2 j ■ S0j * S9j * I 
TBMP10 ’ » S0 * S0 T * 1 

ZjA J J 

TEHPlOg 3 “ S0 J * S0J * 1 

TEMPlOg 1 = - S9j * C0 7 * 

1EMP10 3 2 = - S9j * C0j * 

TEMP10 3 3 ° - SBj * C0j * 

[tem?u| » [temp 7 ] + [tehpiq]' 
[eej] - [o,c_] * [temph] 


» C9j * TEME9 X ^ + S0J * TEMP9 3 ^ , 

« C9j * TEMPS^ + Sflj * TB£P9 3 , 2 
= C9j * TEMP9 j L * 3i + Sflj * TEMP9 3 3 . 

“ S0j * S0j * TEMP9^ J _ + C0j * TEMP9 2 - S0j * COj * TEMP9 3 ^ 

“ S0j * S9j * TEHP9 1 2 + O0J * TEMP9 2 ’ 2 - S0j * COj * TKMP9 3 ’ 2 

“ S0 J * SQj * TEMESj^ 3 + C0j 'k TEMP9 2 3 - S0j # COj * temp9 3 3 

“ - S0j * C0j * TEMP 9 ^ j + S0j * TBffi9 2 ' y + C0j * C0j * TEMP9 3 1 

« - S0J * C0j * TEMP 9 2^2 + S0j * TEMP9 2 ’ 2 + C0j * COj * TEMP9 3 ’ 2 
** - S0y * C0j * XEMPSj, 3 + S0j * TEME9 2 3 + C0 j * C0j * TEMB9 3 ’ 3 




ECT « FEE 1 + ET J 

[eee] - [eee] + [eej] 


(GO TO IQ) 
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FLOW CHART & BLOCK DIAGRAM 


f DEV. 1 I Oi-OI !4-«4 > 



» lt l “ *0,1,1 + *1,1,1 + ”1 * d 01y * ' W + "l * d 01* * < R ly S9 l + W 

+ “2 * ( V 9 1 " W * (d 01y + 4y CS l “ W 

+ “2 * ( V 9 1 + W * (a 0l» + Ay SS l + Az C V . 

+ "3 * ^y 09 ! - R 3 * s 0 1> * (d Qly + d 13y C0 l “ d 13x S0 l + 4y C9 i " 4* Sfl l) 

+ “3 * <V 9 1 + W * < d 01x + a i3y 36 l + d 13, C0 l + Ay S0 l + i 3* C9 l ) 

+ m 4 * (R 4y C9 : - ^SQj) * (d Qly + d 14yC9l - d l4a S 01 + l ^ COj - LsOJ 

+ m 4 * + R 4 e C 9 x ) * (d 0te + d 14y S 01 + d 14jc C0 1+ 

“l,2 “ *0,1,2 + *1,1,2 * C9 1 “ *1,1,3 * se x " “1 * R li * d 01y 

-^* B 2 X *( a 01y + V 8 1" ^ 39 1> 

- “3 * ^ * «01y + d 13y"l " d 13x 39 l + { 3y C9 l “ W 

“ ”4 * V * (d 01y + d 14y° 9 l “' d 14x S0 l + Ay C9 l ’ Az S V 

*1,3 “ *0,1,3 + *1,1,2 * S9 1 + *1,1,3 * C9 1 ’ "l * R l* * d 01* 

“ “2 * *2* * (d 01* + 4y S9 l + 4* C V , 

“ “3 * *3* * < d 01* + W # 1 + d 13/ 9 l + V 9 1 + V 9l> 

- m 4 * V * < d 01x + d Uy S9 l + d 14x C0 l + Ay S9 l + V 9 ^ 

*1,4 “ *1,1,1 ‘ ”i * d 01x * C(m o /Q) * d 01x - V 9 1 ' W 
+ ^ * d{)ly * (R ly C0 JL - B lz S9 1 - (m o /n) * d Qly ) 

" "2 * < d 01z + V 8 1 + i 2 S G9 l ) * <(n o /m > * d 01* “ V S6 1 " W 

+ ^ * <d 01y + / 2y C8 X - VV * C V 9 1 " R 2= S9 1 " ( V a) * d 01y> 

- “3 * < d 01x + (d 13y + V S9 1 + (d 13 2 + 4*>-* G V * «“«/“> * d 0 l 2 " ^y 39 ! ’ VI 

+ “3 * < d Oly + (d 13y + Ay* 39 ! - < d I3x + hi * S9 1> * (R 3y C9 l " Vl “ V") * d 01y) 

" »4 * < d Ota + (d i4y + Ay) 39 ! + (d 14s + hi * 09 1> * «V m > * d 01z " R 4y S0 l “ W 

+ »4 * <d oly + (d 14y + i 4y )C9 1 - Cd 14j6 + * sop * (R^ - R 4x S 9l - Cm 0 M) * d Qly ) 

«1,3 " “ "3 * *3* * (S 3x * Ax - S 3* * hi 


•“3*%y* (“ S 3y * 


hx. + S 3x * 


“1,5 “ “ “4 * K 4z * (S 4x * Ax “ S 4x * Kl 

+ “4 * R 4y * <“ S 4y * hx + S te * Ay 5 

«2,1 - *0,2,1 + *1,2,1 * C9 1 “ *1,3,1 * S9 1 " “1 * d 0lx * Vi " W 9 l) 
" «2 * < V 9 1 - W * < d 03x + A 1 

- “3 * <V 9 1 - ^X 39 ! 5 * (d 0te + d 13x + Ax) 

- * cy > \ - yv * * d oix + d i 4 x + Ax> 


CONTINUE TO TER NEXT' PAGE 


4--. •• 
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SUBROUTINE. EMCALG. CONTINUED 


OCTOBER 1970 


CART JOHNSON 


CONTINUED FROM THE PREVIOUS PAGE 


“3,3 ” *0,3,3 + *1,3,2 * S9 1 + *1,2,3 * C °1 * S0 1 + "l.S.R 09 ! * E9 1 + *1,3,3 * C9 l 

+ “1 * *1* * d 01x + ”1 * <V 9 1 " W * V + ”2 * *2* * (d Oix + 4c> 

+ "2 * • W * (d 01 y + V 9 1 - ^z S 6 l> 

+ "3 * ^x * (d 01x + d 13x + 

+ ^ * (B^ - R 3z S 9 1 ) * (d y +-d 13yC9l - d 13z S 01 + £ 3y C h - i 3z S9 1 ) 

+ e 4 * R 4x * W 01x + d 14x + 

+ m 4 * (R 4y c ei - r 42 s 9i ) * (d Qly + d 14yC9l - d 14z s 9l + i 4y c 9l - i^sop 
“3 4 “ *1 1 2 * S9 1 + r i 1 3 * C9 i 

+ m l Vd 01* * d 01z “ W 9 ! " W 

+ “2 * < d oi* + 4 x> * d oiz - V 9 i " W 

+ “3 * < d OJx + d 13x + 4*> * «V m > * d 01z “ ^y 59 ! “ V»l> 

+ m 4 * (d 01x + d 14x + 4x> * «“b /m > * d 01x " V G 1 ' R 4z C9 l> 

“3,5 “ <“3 * *3* * <" S 3z * + S 3y * / 3 *> 

" "3 * *3x * <- S 3 y * 4x + S 3x * 4y» * S9 1 


+ (- tn 3 * 


* (- S, 
y ' 3* 


+ s 3 


+ “3 **3** (S 3z* hx - S 3 


« 3Z » * C9 1 


“3,6 ** (a 4 * R 4z * S 4z 


* L + s. * L ) 

; 4y 4y . 4z 


- “4 * R 4x * (" S 4y * 4x + S 4x * ^4y» * S9 1 
+<-^ * r a, * C~ S A, * 4„ + S A„ * kJ 


+(■“4 * R 4 y * ( 
+ m 4 * r 4x * (S 


• 4z 4y T 4' 
'4z * 4 x" S 4x* 


4y "Uz' 

* 4 Z » * OBj 


DEFINE SOME REOCCURRING TERMS 

SE 3 - “3 * < d l3y + K? 
s \ " ”3 * < d 13z + 4z> 

SE 5 “ “4 * < d 14y + UP 
SR 6 “ “4 * < d 14* + kz> 

S h - *1. 1,2 ' "2 * % * *2* ' SR 3 * *3* " SR 5 * R 4x 

SR 2 = *1,1,3 ' “2 * Hz * *2x “ SR 4 * *3x “ SR 6 * R 4x 

“4,1 - *1,1,1 + “2 * ^2z * *2* + W* V + SR 4 * *3* + SR 3 * *3y + ^ + : 

M 4,2 “ SR 1 * C9 1 - SE 2 * se i 

M 4 3 «■ SI^ * S 9l + SR2 * C 9jl 

REDEFINE SRj^ AND SRg 

SR 1 = (m o /m) * <d * C 9]l + * 89^ 

SR2 = C» /*> * (- d Qly * S 9l + d Qlz * C 9l ) 
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FLOW CHART & BLOCK DIAGRAM 



CONTINUED FROM THE PREVIOUS PAGE 


%4 “ + *2 * <Ax * «2* “ S V + Ay * (B 2y “ S V> 

+ SR 4 * (Kjj. - SRj) + SRg * (Rj y “ SE 1 ) + SR 6 * (R 40 - SR^) + * (R 4y - SR,_) 


M 4»S 

“”3 * 

«<¥ - 

S ¥ 

* Ax 

+ (E 3y 

- SR 1 ) * 

Ay 3 


(S 3y 

- SR 1 ) * 

Ax 

* S 3y 

“ <R 3s 

SR 2 ) * 

Ax * 

M 4,6 

* m, * 
4 

«( R 4x " 

SRj) 

* Ax 

+ (R 4y 

- SR 1 ) * 

,v 


" (R 4y 

- SRj) * 

Ax 

* S 4y 

“ Ax “ 

s v * 

Ax * 

“5,1 

“ “ “3 

* Ax* 

% 

* S 3y 

+ R 3s* 

S 3*> 


**5,2 

“ Mg * 

«(A** 

Ax 

+ Ax*V* 

®1+A. ?** 


+ (-4 

*.? As^I - 

(Ay* 


* S9 r 


«S,3 - “3 * <<<*3* * *3* + Ax * V * S6 I - Ax * *3y * C9 1> * S 3y 
+ <- Ay * Sx * S9 1 + ( Ay * *3y + Ax * V * ^ * V 

«5,4 * “3 * Ax * «“ *3? + S V * s 3y + <“ *3s + S V * S 3s> 

Hj 3 = «3 * (1. ■ Hj/ioms) * (((/ 3 * + A^* S 3y . - 

" I 3 * * Ay * S 3x) * s 3y + «Ay + Ax> * S 3s " Ay * Ax * V * S 3»> 

« 5 6 « (“3 * V n > * «"^3x * As + V* A* 5 * S 4y + A* * Ay * S 4x> * S 3y 
’ + (-(i 3 y * Ay + Ax * Ax> * S 4x + Ay * As * V * V 

«6,i “ - “4 * Ax * < R 4y * S 4y + A* * S 4x> 

M 6,2 * m 4 *•:<« A. * R 4. + Ax * V * <*1 + Ax * W * S 4y 

+ (- i 4y * *C8 l - (i 4y * * 4y + i 4x * v * S V * V 

M 6.3 " m 4 * <«As * R 4 s + Ax * V * S °i " As * V * C V * S 4y 
+ (- Ay * R 4 x * s8 l + ( Ay * % + Ax * R 4 x> * C9 P * S 4s ) 

V " ”4 * Ax * «" R 4y + SR 1> * S 4y + R 4s + S ¥ * As: 1 

M 6 5 - 0-3 * V m > * «-<Ax * A* + Ax *■ Ax> * S 3y + As * Ay * S 3s> * S 4y 
’ + <-(/ 4y * i 3y + / 4 x *; Ax> * S 3s + Ay * As * V * V 

M 6 6 “ “4 (1 ; ' V? * <«* 4s + J?4x> * S 4y " Ax * Ay * V * S 4y 
+ «Ay + Ax> * S 4s " Ay * Ax * V * V - 

[m] * [m] + [eke] 


f \ 

RETURN 

A J 
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FLOW CHART & BLOCK DIAGRAM 


. Do!o OCTOBER 1970 : 

_ Drown By GARX J.QfflSON 


- S9 0 * IIB0 1 L + C9 0 * TIB0 2 x 

- S0 O * TIBO^ + C0 O * 11802*2 

- S9 0 * TIBO^ + C0 O * TIB0 2 ; 3 

DB x * R ox + DB y * R oy + ™ Z * R cx 

0 * m * (3. * REMP * DB - R ) 

1 o . O 

1 1 * DB + I. , , * DB + I ' , * DB 

0,1,1 x 0,1,2 y 0,1,3 z 

I„ . * DB + I„ „ „ * DB + I„ „ _ * DB 

0,2,1 x 0,2,2 y 0,2,3 z 

, * DB + I n , „ * DB + I * DB 

0,3jl x 0,3,2 y 0,3,3 z 

3. * C * (DB * A - DB * A ) 

lye z y 

3. * C, * (DB * A - DB * A ) 

1 * X XX 

3, * C, * (DB * A - DB * A ) 

1 x y y it' 

- S9g * IIB0 1 1 + C9 0 * X1B0 2 

C9 l * (- S9 0 * TIB0 1 j + C9 Q * XIB0 2 2 ) 

■ S0 L * (- S9 0 * TXBO^ 3 + C9 0 * XIBO z 3 ) 

- S0 t * (- S9 0 * TIB^ 2 + C0 Q * TIB0 2 2 ) 

M 1 * <- S9 0 * TIB0 1, 3 ’ + C9 0 * IIB0 2,3> 


CB x * R lx + DB y * R ly * R lz 

Cj * * (3. * REMP * DB - R^) 

I l, 1 ,l* ra * + I l,1.2* DB y + 1 l,l,3* DB . 

*1.2.1 * DB x + *1,2,2 * DB y + *1.2.3 * DB z 

I. « , * DB +1, , , * DB + I. , , * DB 

1,3,1 x 1,3,2 7 1,3,3 z 

3 # * C 1 * (DB. * k - DB * A ) 

i. y a z y 

3. * C. * (DB * A - DB * A ) 

1 z x x a' 

3. * C. * (DB * A - DB * A ) 
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FLOW CHART & BLOCK DIAGRAM 


f 4 • ' 


SUBROUTINE RE CALC 


„ Dnln OCTOBER 1970 Pqqq 1 of I 

.Drawn fty ‘ GARY JOHNSON „ 


Ax “ 4 * se 3 

Ay “"A * CI 


Ay “ "A * C9 3 * S 3* 

C9 3 * S 3y 
Ax = 4 * S0 4 
4y “ ’A * C9 4 * S 4* 

Ax = h * ce 4 * s 4y 
R lx“ (°o /n) * d 01 x~ (m 2 /m) 


- (nu/m) * (d + i, ) 

-<V">*< d i 4 * + Ax> 

R ly “ (Q o /m) * (d 01y * CS 1 + d 01 

- (o 2 /“) * Ay 

- <^/«0 * (d 13y + Ay) 

- (m 4 /m) * (d 14y + i 4 y) 

R lz “ (m o /n) * <“ d 01y * S8 1 + d 

- (^/m) * l 2z 

- (“ 3 /") * ( d 13 * + 

“ 0 » 4 /m)_* (d^ 

^ = A + 4 _ - 

*3 “ *1 + d 13 + t 




EETOBN ' 

V 
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FLOW CHART & BLOCK DIAGRAM 

*‘<v :i*< >«*!.)» i 


Application SUBROUTINE SSGALC 
Procedure 


, Dale OCT OBER li j70. Pane J.„ .of X. 

.Drown By GARY JOHNSO N 


ENTER 
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FLOW CHART & BLOCK DIAGRAM 

e ** / M '*•$! -h - 'i 


Application SUBROUTINE SYEQNS CONTINUED Dcitg OCTOBER 197D p aDe 2_ of_2 

Procedure Drown By GARY. JJDKi SON 



D-42 











D-43 






FLOW CHART. & BLOCK DIAGRAM 

fiv ;es tt-*i < 



SUBROUTINE TORK13- 

Date OC1 

rOBER 1970 Pnnn 1 nf 1 
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APPENDIX E, SUBROUTINE DESCRIPTIONS 


Subroutine: CMG 

Purpose: This subroutine computes the angular momenta produced 

by the CMGs located on body 0, Either 2 degree of freedom, 1 degree 
of ^freedom or reaction wheels can be accommodated. 

Input/ output : 


I/O 

Fortran 

Name 

Nath 

Symbol 

' 

Definition 

I 

NUMCMG 

N 

CMG 

The number of CMGs located on body 0 

I 

IDOF(K) 

I D0F 

The number of degrees of freedom for 
the kth CMG 

I 

HW(K) 

H 

.The momentum of the kth wheel 

I 

AII(J ,K,M) 

X I 

The Inertia matrix of the inner gimbal 
including wheel. The subscript J 
refers to the CMG being referenced, 

K, and M are dimensioned 3 and 
accommodate the inertia matrix 

- I 

AI0(J,K,M) 

• ' X o 

The inertia matrix of the outer 
gimbal. The meaning of the subscripts 
are the same as AII(J,K,M) 

I 

THATA(J) 

9 j 

The inner gimbal angle 

I 

FEE(J) 


The outer gimbal angle 

I 

TRATA(J) 

• 

9 j 

The time 'derivative of 9. 

J 

I 

FEED(J) 

V 

The time derivative of 0^ 

0 

FFF(M) 

f 

The total angular momentum of the 
CMGs which is not a function of the 
angular rates 

0 

EEE(M,N) 

E 

The total angular momentum of the 
CMGs which is a function of the 
angular rates. For further discussion 
see the Appendix 
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Subroutines required; None 
Discussion.: Nona 
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Subroutine ATT 


Purpose: This routine simulates the action of an attitude 

control system us ing -reaction jets. 

Input/output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

wo (3) 

“o 

Angular rates of Body 0 (stator) 

I 

TIBO (.3,3) 


Transformation from Body 0 to 
inertial frame 

I 

GA (3) 

CA 

Direction cosines of reference 
direction 

I 

TIME 

t 

Time 

I 

B0DY1I (1,] 

[> S,. 

^Moment of inertia around spin axis of 
rotor 

I 

0MEGA1 


Gimbal rate of rotor 

I 

DELTAT 

At 

Time increment per step 

0 ' 

TQOP (3) 


Control torques 

0 

FAT ( 8) 


Control forces 

I 



AO J ( 3) 

' 

Reaction jet lever arms 


Subroutines required: none 

Equations programmed: AK = ^ sin/3/2 /(I). 5 + At) 

coordinate transformat ions 

Discussion: A complete description of this routine is 

given in the final report. 

In order to activate the attitude control function it is 
necessary to set both IPROPF and IATTIF in the input data. 

The attitude section also requires designation of the three 
direction cosines (CA(1), CA(2), CA(3)) of the direction in 
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Inertial apace at which control is desired. For a reorientation 
maneuver the initial orientation of the spin axis is 'inertial 
space read in (11201(1,1), TIB0I(2,1), TIB0I(2,3) are the initial 
direction cosines of the. spin axis in inertial space) can be 
specified different from CA. It is necessary, however, to 
ensure that the angle between the initial direction of the 
spin axis and the direction to which it is commanded to be 
redirected be not greater than 60° for the attitude control 
routine employed in this program. 

The propulsion control section must be supplied with 
appropriate jet couple lengths and control gains for removal 
of transverse angular rates (see discussion on PCON subroutine), 
The control can be on either Body 0 or Body 1 or on both. 
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Subroutine : EMGALC 


Purpose i Subroutine EMCALC assembles the M matrix used in the 
calculations from which the angular velocities are computed. 


Xnput/output: 


B 

Fortran 

Name 

' Math 
Symbol 

f 

Definition 

i 

I 

THETA1 

9 1 

Angular displacement between 'bodies 0 
and 1 

X 

Rl(3) 

r l 

Vector distance from, system c.m. to 
the c.m. of body 1 

I 

R2(3) 

M 

r 2 

Vector distance from system c.m. to 
the c.m. of body 2 

I 

R3(3) 

*3 

Vector distance from system c.m. to 
the c.m. of body 3 

I 

R4<3) 

r 4 

Vector distance from system c.m. to 
the c.m. of body 4 

I 

EL2 (3) 

h 

Vector position of the movable mass 

I 

EL3(3) 

h 

Vector position of body 3 from hinge 
line Sg 

I 

EL4(3) 

K 

Vector position of body 4 from hinge 

line s, 

4 

I 

D01(3) 

3 01 

Vector distance from the c.m. of 
body 0 to the hinge line of body 1 

X 

D13<3) 

*13 

Vector distance from ::he c.m. of 
body 1 to the hinge l:.ne of body 3 

X 

B14(3) 

5 14 

s 

Vector distance from the c.m, of 
body 1 to the hinge line of body 4 

I 

BOMASS 

m Q 

Mass of body 0 







1 

S2MASS 

m 2 

Mass of body 2 


X 

B3MASS 

m 3 

Mass of body 3 


X 

B4MASS 

m 4 

Mass of body 4 


I 

TOTMAS 

m 3 

Mass of composite body 


I 


A 1 

Coordinate trans format .on from 
body 0 to body 1 

X 

Rl<3) 

X 1 

Vector distance from system c 
to the c.m. of body 1 

Lm, 

X 

R2(3) 

*2 

Vector distance from tl e system 
c.m. to the c.m. of bo^y 2 

I 

R3 (3) 

*3 

Vector distance from tie system 
c.m. to the c.m. of body 3 

I 

BOBYOI (3,3) 

I o 

The inertia matrix of iody 0 . 

l 

I 

B0DY1I (3,3) 

X 1 

The inertia matrix of body 1 

i 

( 

i 

I 

S3(3) 

s 3 

The hinge line of body 3 - 

{ 

1 

X 

; 84(3) 

"4 

The hinge line of body 4 i 


0 

EM(6,6) 

m ij 

The M matrix 



Subroutines required: None 

Equations programmed: The M matrix is irelated to the angular 

momenta and the angular velocities by the equation’ shown below: 
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Subroutine FOMS 


Purposes This integration, routine calculates values of a 
aat of variables at time t n ^ from their values at t n and their 
derivatives at times t n and 

Calling Sequences FOMS (A, B, N, E, TJ) 


Input/ output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

A(I) 

x i,n 

ith variable at time t } i = 1, '2 
. . ,aj I ■ i + 1 U 

0 

A(I) 

X i,n:rt 

ith variable at time t , - 
— n+1 

I 

B(I) 

i,n 

ith derivative at time t 
— n 

I 

N 

m 

Number of variables to be inte- 
grated} m = N-l 


E 


Flag to use current derivatives 
for past derivatives on first 
integration 

I 

TJ(I) 

X i,n-1 

ith derivative at time t , 
— n^l 

0 

'TJ(I) 

• 

X. 

i,n 

ith derivative at time t j storage 
for next step 


Subroutines required: none 

Equations programmed: x n ^ “ + 1/2 At(3x^ - 

Discussion: The variables and derivatives are indexed over 

values of I from 2 to N. B(l) is used to bring in At. A(l) 
is set up to be used for time but is not used in this program. 

On the first integration the current derivatives are also used 
as past derivatives since no past derivatives are available. 
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Subroutine GGRAD 


Purpose: This subroutine calculates the forces and torques 

due to gravity gradient on Body 0 and Body 1. 

In] it/output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

THETO 

9 o 

True anomaly 

I 

TIBO (3 } i) 

&»B ] 0 

Transformation from Body 0 to 
inertial frame 

I 

BODY0l(3,3) 


Moment of inertia matrix of Body 0 

I 

B0DY1I&3) 

hi] 

Moment of inertia matrix of Body 1 

0 

F01(3) 

F oi 

Force on Body 0 due to gravity gradient 

D 

Fll (3) 

S u' 

Force on Body 1 due to gravity gradient 

0 

TQ0G(3) 


Torque on Body 0 due to gravity 
gradient 

0 

TQlG (3) 


Torque on Body 1 due to gravity 
gradient 

I 

Cl 


Gravitation constant and earth 
radius factor 

I 

BOM&SS 

a o 

Mass of Body 0 

I 

BlMASS • 

m l 

Mass of Body 1 

I 

THETA1 

e l 

Gimbal angle of Body 1 

I 

RO (3) 


Distance between centers of mass 
of Body 0 and system 

HI 

R1 (.3) 

n 

Distance between centers of mass 
of Body 1 and -system 
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Equations programmed: 


Torque: T Q » - R Q * fc'RgJ 


Force: F Q - (v - -fa“ R Q ) 


3 V r * 


R. 


where Rq => distance to center of earth 

r = distance between center of mass of body and 
center of mass of- system 


Discussion:- The translational motion is limited to circular 
orbits in the X-Y inertial plane in order to simplify transforma- 
tions and relationships in this subroutine. Gravity gradient 
effects on Body 2, Body 3 and Body 4 are neglected. 
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Subroutine : HCON 


Purpose: The subroutine contains the control laws in terms of 

gimbal angle rates for the CMGs. In most cases the user must furnish 
his own control law. 


Input ''output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 



Any program variables to be used in 




the control law 

0 

FEED(J) 


Outer gimbal rate of the Jth CMG 

'0 

THATAD(J) 


Inner gimbal rate of the Jth CMG 


Subroutines required: CMG 

Discussion: None 
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Subroutine MULT 


Purpose: Subroutine MULT multiplies either and 3x3 matrix 

.by a 3 x 1 matrix or a 3 x 3 matrix by a 3 x 3 matrix. 

Calling sequence: CALL MUTL (C, A, B, F, D, E, MTYPE) 


Input/output : 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition "] 

I- 

A 


A 3 x 3- matrix used in the 
matrix multiplication 
C = A x B 

I 

B 


A 3 x 1 matrix used in the 
matrix multiplication 
C = A x B 

0 

C 


A 3 x 1 matrix which is the re- 
sult of A x B 

" I 

D 


A 3 x 3 matrix used in the matrix 
multiplication 
F “ D x E 

I 

E 


A 3 x 3 matrix used in the 
matrix multiplication 
F “ D x E 

0 

' F 


A 3 x 3 matrix which is the 
result of D x E 

I 

MTYFE 


. A flag which determines the 
type of matrix multiplication 
being performed. If MTYPE = 1 
' then C - A x B is performed, 
if MTYPE 4 - 1 then D- = E x F 
is performed. 


Discussion: When subroutine MULT is used to multiply a 3 x 3 

matrix by a 3 x 1 matrix variables F, D, E are dummies, when used 
to multiply two 3x3 matrices then variables C, A, B axe dummies. 
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Subroutine PCON 


Purpose: To simulate a reaction jet control system for 

removing transverse components of angular velocity, maintaining 
the spin rate of the rotor and removing spin axis angular rates 
of the stator. 


Input/ output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

n 

WO 

w o 

Angular rates of Body 0 

n 

THETA1 ' 

9 1 

Angle of Body 1 with respect to Body Q 

i 

0MEGA1 

G i 

Angular velocity of Body 1 with 
respect to Body 0 

i 

CGAINO0) 


Control gains of stator jets 

I. 

AOJ (3) 


Stator jet couple arm length 

i 

CGAINl'd) 


Control gains of rotor jets 

i 

V A1J(2) 

* 

Rotor jet couple arm length 

- 0 

TQ0P(3) 


Control torques on stator 

o: • 

TQ1P(3) 


Control torques on rotor 

0 

FPT ( 5 ~) 


Control forces 


Subroutines required : none 

Equations programmed: none 

Discussion: Certain restrictions on the configuration of the 

reaction jets have been, assumed. 

Associated with the torque around an axis there are four jets. 
One pair is in a pure couple to produce torque in one direction. 

The other pair. Identical in location and strength, is oppositely 
directed. No torque is produced around axes other than the one 
designated. 

In setting up input data for the reaction jet controls, the 
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control gain of the jets of the couple and the distance between 
the two jets forming the couple must ha specified. Since the 
couples are similar for the two directions, this data is read 
only once for each axis. 

The firing of jets on Body 1 (rotor) must be cimed accord- 
ing to alignment with stator axes. GLmbal angle sensing is 
used in this routine to provide this timing. 

The PCON subroutine :imulates a reaction jet control on 
angular rates. Transvers * control torques are made proportional 
and opposite to transverse velocities. Such a control is similar 
in effect to an external frictional force acting against trans- 
verse motion. For a transverse torque T^, related to the magnitude 
of transverse rate co^ by T^, = - K some estimate of the decrease 
in magnitude of transverse rate over a time interval t is given by 
^T ~ W To 6 where is the initial transverse angular 

rate and I ~-\j ( I + 1, ) (I + I. ). This estimate will be 

1 u 22 L 2Z U 33 1 33 

good for jets on Body 0 where both transverse axes are controlled. 
For the single axis jets on the rotor the control will be much 
slower due to the time that the rotor spends in unfavorable 
positions. 

In Figure jet configurations are illustrated. Note that 
it is not necessary for jets to be symmetrically located with 
respect to any coordinate axes or planes. It is necessary, however, 
thatjjthe X-jet couple arm be parallel to the Y-Z plane, the Y-jet 
couple arm be paralLel to the X-z plane, etc. The data deck is 
simplified by requiring only magnitudes of jet couple arms with- 
out regard for actual directions or components. 

The reaction jets are activated by setting IPROPF = 1 and 
supplying control gain and couple arm length data. If it is 
desired to leave a certain axis uncontrolled, the corresponding 
control gain is set to zero, but the couple arm length should be 
given some non-zero value in order to prevent division by zero 
in calculation of impulse contributions. 
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Subroutine: RECALC 


Purpose: The purpose of this subroutine is to compute the 

distance from combined system center of mass to the center of 
mass of the various bodies. 


Xnput/output : 


I/O ‘ 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

BOMASS 

ra o 

Mass of body 0 

I 

B2MASS 

m 2 

Mass of body 2 

I 

B3MASS 

m 3 

Mass of body 3 

I . 

B4MASS 

m 4 

Mass of body 4 

I 

TOTMASS 

m 

Mass of composite body 

I 

D01(3) 

5 01 

Vector distance from the c.m. of 
body 0 to the hinge line of body 1 

I 

EL2(3) 


Vector position of the movable 
mass . 

I 

D13 (3) 

3 13 

Vector distance from the c.m. of 
body 1 to the hinge line of body 3 

I 

D14 (3 ) 

5 14 

Vector distance from the c.m. of 
body 1 to the hinge line of body 4 

I 

EL3 (3) 


Vector position of body 3 from the 
hinge line 

I 

EL4(3) 

h 

Vector position of body 4 from the 
hinge line 

0 

Rl(3) 


Vector distance from system c.m. 
to the c.m. of body 1 

0 

R2(3) 

? 2 

Vector distance from the system c.m. 
to the c.m. of body 2 
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0 

R3(3) 

r 3 



Vector distance from the system c.m. 




to the c.m. of body 3 

0 

R4(4) 

? 4 

Vector distance from the system c.m. 



4 

to the c.m. of body 4 


Subroutines required: None 

Equations programmed : 
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Subroutine SCALC 


Purpose: This routine supplies -the position of the movable 

mass, Body 2. 


Input/output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

0 

S 

S 

Distance of Body 2 from D12 
along direction S2 


Note: Other 1/0 variables may be employed depending on 

the formulation of the subroutine. 

Subroutines requited: Not specified 

Equations programmed: Not specified 

( Discussion: This subroutine will be constructed to suit 

the needs of the user. Any variables appearing in the common 
region can be employed as input/output variables. 
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Subroutine SDCALC 


Purpose: This routine supplies the speed of the movable 

mass. Body 2. 


Input/ output : 



Fortran 

Math 


I/O 

Name 

Symbol 

Definition 

0 

SDOT 

* 

s 

Magnitude of velocity of Body 2 




along direction S2. 


Note: Other I/O variables may be employed depending on 

the formulation of the subroutine. 

Subroutines required: Not specified 

Equations programmed: Not specified 

Discussion: This subroutine will be constructed to suit 

the needs of the user. Any variables appearing in the common 
region can be employed as input/output variables. 
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Subroutine: S YEQNS (A , N , NR, NC , FLAG) 

Purpose: Subroutine SYEQNS solves a set of linear simultaneous 

aquations Ax = c to determine the column vector x. 


Input/output: 


B 

Fortran 

Name 

Math 

Symbol 

Definition 

I/O 

A 

A 

A is the system matrix as depicted 
above. Also the answer x will appear 
as the N+l at column of matrix A 

X 

N 

N 

N is the number of linear equations 
to be solved 

I 

NR 

NR 

NR is the number of rows in A 

I 

NC 

NC 

NC is the number of columns in A 

0 



FLAG 

FLAG 

If FIAG = 0 as solution exists if 
FLAG = 1 no solution exists 

1 


Subroutines required: None 

Discussion: None 
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Subroutine: T0RK.01 


Eurpose: The purpose of this subroutine is to compute the 

torque acting between bodies 0 and 1. The present version of 
TORK.01 contains a frictional torque as well as torque motor with 
appropriate control law. 

Input/ output : 



Fortran 

Math 


1/0 


Symbol 

Definition 

I 



Any -of the variables carried through 




common 

0 

T01 

T 

i 01 

The torque acting between body 0 and 



body 1 


Discussion: None 
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Subroutine: T0RK13 

Purpose: This subroutine computes the torque between 

body 1 and body 3. 

Input/output : 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

THETA3 

9 3 

Angular displacement of body 3 about 
the hinge line 

: I 

0MEGA3 

3 

Angular velocity of body 3 about the 
hinge line 

I 

CPI 

CPl 

Gain for 

I 

CP2 

CP2 

Gain for 9„ 

0 

T13 

T 

a 13 

The torque acting between bodies 
1 and 3 


Subroutines required ; None 
Equations programmed: 


t ^ x w 3 ~ CP2 x 
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Subroutine: T0RK14 


Purpose’: This subroutine computes the torque, acting between 

body 1 and body 4. 


Input/ output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

THETA4 

0 4 

Angular displacement of body 4 about 
the hinge line 

I 

0MEGA4 

4 

Angular velocity of body 4 about the 
hinge line 

I 

CPI 

CP 1 

Gain for 

4 

I 

CP2 

CP 2 

Gain for 0^ 

0 

T14 

T 14 

The torque acting between bodies 
1 and 4 


Subroutines required: None 

Equation programmed: 


T ].— = - CPI x - CP2 x (Q - ir) 
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Subroutine XDOT 


Purpose: To compute the derivative of the unconstrained 
components of angular momenta as well as the variable required 
for these calculations. 
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Segment 1 


Purpose: To compute the angular velocity of body 1. 

Input/ output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

m 

0MEGA1 


Angular velocity between 

■ 


JL 

bodies 1 and 0 

■ 

WO (3) 

«o 

Angular velocity of body 0 

0 

Wl(3) 

"l 

Angular velocity of body 1 

1 

THETA1 

°1 

Angular displacement between 

9 

■ 

1 

bodies 1 and 0 


Subroutines required : None 


Equations Programmed: 



W lx W 0x 

+ a i 


*0 

w ly “ 

w 0y COs9 l + 

co 

1 


1 

w lz “ 

-" 03 r sl “ 8 l + w Oz cos0 l 



Discussion: The angular velocity of body 0 (<*> Q ) is trans- 

formed to the body 1 coordinate system and is added to_the primary 
gimbal rate to obtain the angular velocity of body l («j). 
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Segn ant 2 . 

Purpose: To compute the vector position of the movable mass 

from the center -of -mass (c.m.) of body 1. 

Input/output: 


I/O 

Fortran ' 
Name 

Math 

Symbol 

Definition 

I 

S 

s 

Movable mass travel, a speci- 
fied s calar function of time 

I 

D12 (3) 

^12 

Fixed vector (in body 1 coordi- 
nates) locating the path of 
movable mass from c.m. of 
body 1 

I 

S2(3) 

h 

Unit vector defining direction 
in which the movable mass 
travels 

0 

E12 (3) 

h 

Position of movable mass 
(in body 1 coordinates) from 
c.m. of body 1 


Subroutines required: None 

Equations programmed: 



Discussion: The position of the movable mass is computed 

from the vector equation^ “ + s 2s* 
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Segment 3 

Purpose: To compute the positions of bodies 3 end 4. 

Input/output: 


I/O 

Fortran 

Name 

Hath 

Symbol 

Definition 

I 

THETA3 

G 3 

Angular position of pendulum 3 

I 

S3 (3) 

"3 

Hinge line of pendulum 3 

I 

PEND3L 

0 

o 

Scalar length of pendulum 3 

0 

EL3 (3) 

h 

Vector position of pendulum 3 
from hinge line s 3 

I 

THETA4 

■ \ 

Angular position of pendulum 4 

I 

S4<3) 

S 4 

\ 

Hinge line of pendulum 4 in 
body 1 coordinated (no dimensions) 

I 

PEND4L 

4 

Scalar length of pendulum 4 

0 

EL4(3) 

h 

Vector position of pendulum 4 


Subroutines required; None 
Equations programmed; 



/ 3x = ji 3 sme 3 


, 

body 1 _ s 3 

4y “ -4 cos9 3 s 3z 

4, 

0 



4* - ^ co 8 0 3 s 3y 

body 1 coords. 

6 4 .. 

4x = 4 sln9 4 


* >■ 

*4 

4y = “4 CO30 4 s 4z 


4 r 


4s - 4 cob9 4 s 4y 

body 1 coords . 


Discussion: None 
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Segment 4 


Purpose:- To compute the center -of mass equations for bodies 0, 
1, 2 and 3. r is defined as the vector distance from the system 
center of mass-' to the center of mass of the jth body. 


Input/output : 










0 

Rl<3) 

X l 

Vector distance from system 
c.m. to the c.m. of body 1 

0 

H2<3) 

r 2 

Vector distance from the 
system c.m. to the c.m. of 
body 2 

0 

R3(3) 

r 3 

Vector distance from the 
system c.m. to the c.m. of 
body 3 

0 

R4<3) 

r 4 * 

Vector distance from the 
system c.m. to the c.m. of 
body 4 

1 


Subroutines required: 


None 




Equations programmed: 



Discussion: None 
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Segment 5 

Purpose: To compute the derivative of th e rate at which 

to movable mass in moving. 

Input/ output : 


I/O 

i Fortran 
Statement 

Math 

Symbol 

Definition 

I 

Wl<3) 

W 1 

Angular velocity of body 1 

I 

EL2 (3 ) 

h 

Vector position of the 
movable mass 

H 

s2(3) 

S_ 2 

Unit vector defining the 
direction of travel of the 
movable mass (body 2) 

B 

S 

a 

Movable mass travel, a 
specified scalar function 
of time 

i 

SDOT 

m 

3 

The time derivative of s. 

0 

EL2B0T(3) 

CM 

The time derivative of 

h 


Subroutines required: SDCALC 

Equations programmed: 
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where 


0 


•Wl(3) Wl(2) 


CPMw^ ® 


Wl(3) 0 -ffl(l) 

-Wl(2) Wl(l) O’ 


Discussion: None 



Segment 6 ^ 

Purpose: To compute the angular /alocity of body 3 (<a^) . 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

Wl(3) 

W 1 

Angular velocity of body 1 

- I 

‘ 

0MEGA3 

* 

°3 

Angular velocity of body 3 
about the hinge line s^ 

I 

s3(3) 

S “ 3 

The hinge line about which body 
3 rotates 

0 

W3(3) 

*3 

The angular velocity of 
body 3 


Subroutines required: None 

Equations programmed: 


"l 

"3x = + "lx 


^ 

*3 - 

"3y = f! 3 s 3y + “ly 

03 

3 


“>3z " ft 3 s 3z * w lz 






Discussion: None 






Segment 7 

Purpose: To compute the derivative of 

Input/ output: 


I/O 

Fortran 

Name 

i 

Math 

Symbol 

Definition 

I 

EL3 (3) 

h 

Vector position of body 3 




from hinge line 

I 

W3(3) 

U> 

3 

Angular velocity of body 3 

0 

EL3D0T(3) 

h 

Time derivative of j[^ 


Subroutines required: None 

Equations programmed: 
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Segment 8 

Purpose: To compute the angular velocity of body 4 

Input/ output : 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

Wl (3) 

5 1 

Angular velocity of body 1 

I 

0MEGA4 

Q 4 

Angular velocity of body 4 
about the hinge line 

I 

S4(3) 

s 4 

The hinge line about which 
body 4 rotates 

0 

W4(3) 

*4 

Angular velocity of body 4 


Subroutines required: None 

Equations programmed: 



Discussion: None 
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Segment 9 

Purpose: To compute the derivative of 

Input/ output : 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

EL4(3) 

h 

Vector position of body 4 
from the hinge line 

I 

W4(3) ’ 

W 4 

Angular velocity of body 4 

0 

EL4D0T(3) 

Ik 

Time derivative of 


Subroutines required: None 

Equations programmed: 
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Segment 10 

Purpose: To compute the time derivatives of an ^ ^14* 

Input/output: 


I/O 

Fortran 

Statement 

Math 

Symbol 

Definition 

I 

D01(3) 

3 01 

Vector distance from the c.m. 
of body 0 to the hinge line 
of body 1 

I 

Dl3(3) 

*13 

Vector distance from the c.m. 
of body 1 to the hinge line 
of body 3 

X 

D14(3) 

3 14 

Vector distance from the c.m. 
of body 1 to the hinge line 
of body 4 

-I 

Wl(3) 

CO 

1 

Angular velocity of body 1 

0 

D01DOT(3) 

«oi 

Time derivative of d^ 

0 

D13D0T(3) 


Time derivative of 3^ 3 

0 

D14D0T(3) 

5. / 
14 

Time derivative of d, , 

14 


Subroutines required: None 

Equations programmed: 




r. t 


r i 


U ° > 




r n 


d 10x 




• 

d. . 

vs 




i 



WL2FI 


■ti 

■ 


1 

3 IQ > 


• 

d 01» 



1 



■ ■ 



01 


"o x d 01 
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Segment 11 


Purpose: To compute the time derivatives to the center of 

mass variables r^, r^, r^ and r^. 


Input/output: 



Fortran 

Statement 

Math 

Symbol 

Definition 

I 

D01D0T(3) 

*01 

Time derivatives of d^ 

I 

EL2D0T(3) 

to 

Time derivative of 

I 

D13D0T(3) 

*13 

Time derivative of d^^ 

I 

EL3DOT<3) 

h 

Time derivative of 

I 

D14D0T(3) 

*14 

Time derivative of d^ 

I 

EL4D0T(3) 

L 

Time derivative of 

I 

RlD0T(3) 

r i 

Time derivative of r^ 

I 

BOMASS 

m o 

Mass of body 0 

I 

B2MASS 

m 2 

Mass of body 2 

I 

B3MASS 

”3 

Mass of body 3 

I 

B4MASS 

m 4 

Mass of body 4 

X 

TOTMAS 

m 

Mass of composite body 
(total mass) 

I 


A 1 

Coordinate transformation 
from body 0 to body 1 

0 

RlD0T(3) 

m 

r l 

Time derivative of r^ 

0 

R2D0T (3) 

*2 

Time derivative of 

0 

R3D0T (3) 

*3 

Time derivative of r 3 

0 

R4D0T(3) 

• 

*4 

Time derivative of 









Subroutines required: None 


Eauations nroaranuned: 



3^ (body 0 coordinates) 

d 10 » 5 13 » 5 14 » \* (b ° dy 1 coordlnates > i' V V 

(body 1 coords,,) 

Discussion: None 
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Hi* 






Segment 12 

Purpose: To compute the angular momentum of body 0 and body 1. 

Input/ output : 


I/O 

. Fortran 
Name 

Math 

Symbol 

Definition : 

I 

WO 


Angular velocity of body 0 

I 

W1 


Angular velocity of body 1 

I 

BODYOI 

I 0 

The inertia of body 0 

I 

B0DY1I 

h 

The inertia of body 1 

0 

HO 

£ 0 ' 

The angular momentum of body 0 

0 

Hi 

£ 1 

The angular momentum of body 1 


Subroutines required: MULT 

Equations programmed:' 




Discussion: None 
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Segment 13 

Purpose: To compute the primed angular momentum of bodies 1, 

3 and 4. 

Input /output; 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

B3MASS 

m 3 

The mass of body 3 

' I 

EL3 (3) 

*3 

Vector position of body 3 
from the hinge line 

I 

R3D0X(3) 

• 

r 3 

The time derivative of r^ 

0 

H3PRIM(3) 

^3 

The primed angular momentum 
of body 3 

I 

B4M4SS 

m 4 

The mass of body 4 

I 

EL4 (3 ) 

K 

Vector position of body 4 
from the hinge line 

I 

R4D0T(3) 

r 4 

The time derivative of r. 

4 

0 

■ H4PSIM(3) 

“ t 

4 

The primed angular momentum 
of body 4 

I 

HI (3) 

\ 

The angular momentum of body 1 

I 

H3PRIM(3) 


The primed angular momentum 
of body 3 

I 

H4PRIM(3) 


The primed angular momentum 
of body 4 

I 

B2M4SS 

m 2 

The mass of body 2 

I 

EL2 (3) 

l 

2 

Vector position of the 
movable mass 

I 

R2D0T(3) 

*2 

The time derivative of r^ 

I 

B3MA.SS 

“3 

The mass of body ,3 
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I 

R3D0T (3) 

* 

r 3 

The time derivative of 

I 

B4MASS 

m 4 

The mass of body 4 

I 

R4D0T(3) 

? 4 

The time derivative of r. 

4 

I 

D13 (3) 

5 13 

Vector distance from the c.m. 
of body 1 to the hinge' line 
of body 3 

I 

D14 (3) 

d_ 14 

Vector distances from the c.m. 
of body 1 to the hinge line 
of body 4 

0 

HIPRIM(3) 

K 

The primed angular momentum 
of bo'dy 1 


Subroutines required; None 
Equations programmed: 
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PRECEDING PAGE BLANK' NOT FILMED 
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Segment 14 

Purpose: To compute the angular momentum of the composite 

vehicle. 

Input/ output ; 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

HO (3) 

h o 

The angular momentum of body 0 

I 

HlPRIM(3) 

4 

The primed angular momentum of body 
1 

I 

001(3) 

a oi 

Vector distance from the c.m. of 
body 0 to the hinge line of body 1 

I 


A o 

Coordinate transformation from 
body 1 to body 0 

I 

BlMASS 

m l 

Mass of body 1 

I 

B2MASS 

m 2 

Mass of body Z 

I 

B3MASS 

m 3 

Mass of body 3 

I 

B4MASS 

m 4 

Mass of body 4 

I 

RLD0T(3) 

• 

r l 

Time derivative of r^ 

I, 

R2D0T (3 ) 

« 

r 2 

Time derivative of r^ 

, I 

R3D0T (3) 

*3 

Time derivative of r^ 

I 

R4D0T (3 ) 

f 4 

Time derivative of 

0 

H(3) 

H 

The angular momentum of the com- 
posite vehicle 


Subroutines- required: None 
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Equations programmed: 



Discussion: None 
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Segment 15 

' Purpose: To compute In body 1 coordinates, the unit vector 

j. This is done as a matter of computational convenience and is 
used in setting up the angular momentum derivatives. 

Xnput/output : 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

EL2 (3) 

^2 



Vector position of the movable mass 

I 

Dl3(3) 

d 13 

Vector distance from the c.m. of 
body 1 to the hinge line of 
body 3 

1 

EL3(3) 


Vector position of body 3 

I 

Dl4(3) 

d 14 

Vector distance from the c.m. 
of body 1 to the hinge line of 
body 4 

I 

EL4(3) 


Vector position of body 4 

I 

BMASS2 

m 2 

Mass of body 2 

I 

BMASS3 

m 3 

Mass of body 3 

I 

BMASS4 

m 4 

Mass of body 4 

0 

Ajl(3) 

h 

Unit vector defined in body 1 


Subroutines required: None 

Equations pr ogrammed: 


K> h> K y 


j Lx 


4 


d 13x 

+ 



' d 14x 

+ 4x' 

V m 3 J m 4. 


^ly 

= ni 

2 

** 

+ m 3 

d 13y 

+ 

** 

+ m, 
4 

d 14y 

*k 7 

d 13* d 14 ^ 

-■ - 1 - 


hz_ 




_ d 13z 


V. 


d 14z 

+ hz 


Discussion: None 



(body 1 
coords . ) 
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Segment 16 

Purpose: To update the orbit angle 0^ and to compute the 

external- forces and momentB. 

Xnput/output : 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

TIME 

T 

The time in seconds 

I 

Ws 

0} 

a 

The orbital rate 

0 

THETO 

Q 

y o 

The orbital angular position 

0 

TQ1G(3) 

t Qig 

The gravity gradient torques 

0 

TQ1P(3) 

TQ ip 

The propulsion torques 


Subroutines required: GGRAD, PCON 

Equations programmed: 


w 


e„ 

__ s 



0- 53 w x T 
0 s 

0 




Discussion: None 
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Segment 17 

Purpose: To sum to forces and moments acting on bodies 0 

and 1. 

Input/output: 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

. F01(3) 

F 01 

Force acting on body 0 due to 
gravity gradient 

I 

Fll<3) 

F 11 

Force acting on body 1 due 
to gravity gradient : 

I 

TQ0G(3) 

^OG 

The torque acting on body 0 
due to gravity gradient 

I 

TQ0P(3) 

T %p 

The torque acting on body 0 
due to propulsion forces 

I 

TQlG(3) 

t ^ig 

The torque acting on body 1 
due to gravity gradient 

I 

TQlP(3) 

TQ lp 

The torque acting on body 1 
due to propulsion forces 

0 

T0EF(3) 

T 

OeF 

The summation' of the torques 
acting on body 0 

0 

T1EF(3) 

T leF 

The summation of the torques 
acting on body 1 


Subroutines required: None 

Equations programmed: 
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Segment 18 

Purpose: To calculate the time derivatives of the angular 

momentum of the composite vehicle. 

Input/output : 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

■ 

WO (3) 

"o 

Angular velocity of body 0 

1 

H(3) 

H 

Angular momentum of the 
composite body 

m 

TOMAS 

m 

Mass of the composite body 

• i 

BOMASS 

m o 

Mass of body 0 

i 

D01(3) 

*01 

Vector distance from the c.m. 
of body 0 to the hinge line 
of body 1 

i 

AJ1(3) 

h 

A vector, defined in body 1 
coordinates used only for 
computational convenience 

i 

FO (3) 


Summation of the forces acting 
on body 0 



A o 

Coordinate transformation from 
body 1 to body 0 

i 

T0EF(3) 

^OEF 

Summation of the torques acting 
on body 0 

i 

TlEF (3) 

t" 

1EF 

Summation of the torques acting 
on body 1 

0 

HD0T(3) 

dH 

dt 

The time derivative of H 


Subroutines required: None 
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Discussion: The following vector equation is programmed in this 

segment : 


dH 

dt 



x H ° 


{- 


(m-m 0 )d 01 
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Segment 19 


Purpose: To calculate the time derivative of h| about the 

unconstrained axis x^. 

Input/output; 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

Wl(3) 


Angular velocity of body 1 

I 

H1PRIM(3) 


The primed angular momentum 
of body 1 

I 

B2MASS 


Mass of body 2 

I 

EL2D0T (3) 

4 

Time derivative of 

X 

JR2D0T (3) 

« 

r 2 

Time derivative of r^ 

I 

B3MASS 

m 3 

Mass of body 3 

I 

D13D0T(3) 

• 

?13 

Time, derivative of d^^ 

I 

EL3D0T(3) 

4 

Time derivative of 

B 

R3D0T(3) 

*3 

Time derivative of r^ 

H 

B4MASS 

y 

Mass of body 4 

X 

Dl4D0T(3) 

?14 

Time derivative of 3^ 

i 

EL4D0T(3) 

4 

Time derivative oi 

i 

R4D0T (3) 

4 

Time derivative of r, 

4 

i 

AJl(3) 


A vector, defined in body 
1 coordinates > used for 
computational convenience 

i 

TlEF (3 ) 

t ief 

Summation of the torques 
acting on body 1 

i 

T01 

T 0-*-l 

The torque acting between 
bodies 0 and 1 

0 

HlPDOT(l) 

h' 

lx 

Time derivative of h! 

lx 
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Subroutines required: TORKOl 

Equations programmed: 

Unconstrained compont at along x^ ■ x^ (axis) 



Discussion: None 
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Sagwwiifc 20 


Purpose: To cal.cuJ.afce the time derivatives of the primed 

angular momenta about the unconstrained axes S 3 and s^.. 

Input/ output j 


I/O 

Fortran 

Name 

Math 

Symbol 

Definition 

I 

H3PRIM(3) 


The primed angular momentum 
of body 3 

I 

S3 (3) 

■s 

The hinge line of body 3 

I 

Wl(3) 

5 1 

The angular velocity of 
body 1 

I 

B3MASS 

?3 

Mass of body 3 

I 

EL3D0T(3) 

h 

Time derivative of H 3 

; i 

R3DOT(3) 

• 

r 3 

Time derivative of £3 

I 

EL3(3) 

^3 

Vector position of body 3 
from the hinge line S3 

i 

B4MASS 

m 3 

Mass of body 4 

i 

TOTMAS 

m 

Mass of composite vehicle 

i 

F0(3) 

*0 

Summation of the forces 
acting on body 0 

fl 

Fl<3) 

? 1 

Summation of the forces 
acting on body 1 

D 

T13 

*l+-3 

Torque acting between bodies 
1 and 3 

0 

G3D0T ™ 

(£^*83) 

Time derivative of the un- 
constrained component of £3 

I 

H4PSIM(3) 

— 

K i 

The primed angular momentum 
of body 4 
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I 


— — 

I 

S4<3) 


?4 

The hinge line of body 4 

I 

EL4D0T<3) 

K ' 

Time derivative of J ^ 

I 

R4D0T<3) 

• 

*4 

Time derivative of r^ 

X 

EL4(3) 


K 

Vector positlon_of body 4 from 
the hinge line 

I 

T14 


*l-*~4 

Torque acting between bodies 
1 and 4 

0 

G4D0T 

nr 

, dt 

< £ 4' S V 

Time derivative of the un- 
constrained component of h^ 


Subroutines required: T0RK13, T0KK.14 
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Equations programmed: 

It (S 3- S 3> + s 3y <"lz h 3x " + a 3z <"lx4y ' "ly h k> “ 

”3 s 3y ^3z*3x * K’/lz.' * nl 3 s 3z ( ^3x f 3y " hy i 3x > 

+ IT a 3y ^3z < F 0x + F lx> ' l 3x F 0y sin6 X + F 0 2 -=° s6 l + F lz> 

+ 5T s 3z ^3z ^ F 0y cos6 l + V” 1 * 9 ! + V ’ 4y < F 0x + F lx> 




+ s 4y < w l* h i* " w l X h 4a ) + S 4z (a, lx h 4y “ "l 7 h ix> 


m m 4 s 4y ^4z*4x'~ ^4xV + m 4 s 4y ^4x r 4y " ^4y r 4x^ 


+ r S 4y Kz ^ F 0x + F lx> " 4c <- F 0y slnQ l + F O* COS0 1 + F lz> ’ 

+ ST s 4z hx < F 0y cos9 l + F 0z sin9 l + V * Ky <*0z + F lx>. + T X~4 


(body 1 coords*) 


Fq (body 0 coords.) 


It = 3F < h 3y s 3y + h k s 3* 


ft H'h) “ It (h 4y s 4y + h 4z f, 4z> 


(body 1 coords.) 


Dis cus s ion : None 



